Bayesian Estimation of Follower and Leader Vehicle Poses with a Virtual Trailer Link Model

Abstract

Autonomous Vehicle Following can be achieved if the poses of both the follower and leader vehicles are continuously estimated. This can be achieved by using a Bayesian estimation technique together with a virtual trailer link model. The advantage of such a model is that the follower vehicle will trail a virtual trailer, modeled as an attachment to the leader vehicle, instead of the leader vehicle itself, so that a safe spacing between the two vehicles is guaranteed. The key to a tractable solution to this vehicle following problem is the justifiable assumption that the pose of the follower vehicle is statistically independent of that of the leader. This assumption is valid when conditioned on the history of the follower vehicle's inputs and the sensor observations made by the follower vehicle. Hence, a factored solution to the joint estimate of the follower and leader poses can be formulated. Due to the factored solution, the pose of the follower vehicle is estimated separately using a recursive estimator. In a separate estimator, the poses of the virtual tailer and the leader vehicle are augmented in the tracking process of the leader vehicle. The aim is to command the follower vehicle to trail the estimated pose of the virtual trailer link model. The pose of the virtual trailer is computed with an on-board sensor mounted on the follower vehicle. A case study on the implementation of the proposed formulation, using an Extended Kalman Filter as the main estimator, is presented. First, simulation results are presented. To make the simulation results comparable to the actual system, the variances of sensor measurements are set according to real sensor data-sheet values. Various types of vehicle maneuver, such as straight paths and clothoids with left and right transition paths, are considered. Real experiments are also carried out in a car park. A comparison of the estimated paths and the best available ground truth is presented. The path deviations of the proposed system are also compared with similar systems in the literature.

Keywords

vehicle following target tracking virtual trailer

Get full access to this article

View all access options for this article.

References

Bar-Shalom, Y. and Fortmann, T.E. (1998). Tracking and Data Association. Mathematics in Science and Engineering. Academic Press.

Bar-Shalom, Y. and Li, X.R. (2001). Estimation with Application to Tracking and Navigation . John Wiley and Sons Inc.

Borodani, P. (2000). Full automatic control for trucks in a tow-bar system. In Proceedings of International Symposium on Advanced Vehicle Control, pp. 131—138.

Chen, C. , Wang, H. , and Ng, T.C. (2004). Target tracking and path planning for vehicle following in jungle environment. In 8th International Conference on Control, Automation, Robotics and Vision, pp. 455—460.

Committee on Army UGV Technology (2002). Technology Development for Army Unmanned Ground Vehicles. Washington, D.C.: The National Academies Press.

Dissanayake, G. , Newman, P. , Clark, S. , Durrant-Whyte, H.F. , and Csobra, M. (2001). A solution to simultaneous localisation and map building (SLAM) problem. IEEE Transactions of Robot Automation , 17(3): 229—241.

Fujioka, T. and Suzuki, K. (1994). Lateral autonomous driving by sliding control . In Proceedings of International Symposium on Advanced Vehicle Control, pp. 432—437.

Liu, B. , Adams, M.D. , and Guzmàn, J.I. (2005). Multi-aided inertial navigation for ground vehicles in outdoor uneven environments. In IEEE International Conference on Robotics & Automation (ICRA), pp. 4703—4708.

Lu, G. and Tomizuka, M. (2005). Vehicle following as backup control schemes for magnet-magnetometer-based automated highways. IEEE Transactions on Control System and Technology, 3(2): 274—285.

10.

National Academy of Engineering (1998). Frontiers of engineering: Report on leading edge engineering from 1997. In Symposium on Frontiers of Engineering , pp. 89— 102.

11.

Ng, T.C. , Adams, M.D. , and Guzmàn, J.I. (2005). Autonomous vehicle-following systems: A virtual trailer link model. In Proceedings of International Conference on Intelligent Robots and Systems (IROS), pp. 2968— 2973.

12.

Ng, T.C. , Guzmàn, J.I. , Shen, J. , Gong, Z. , and Chen, C. (2004). Vehicle following with obstacle avoidance capabilities in natural environments. In Proceedings of IEEE International Conference on Robotics and Automation, pp. 4283—4288.

13.

Nguyen, V. , Martinelli, A. , Tomatis, N. , and Siegwart, R. (2005). A comparison of line extraction algorithms using 2d laser rangerfinder for indoor mobile robotics. In IEEE International Robotics and System, IROS, pp. 1829—1834.

14.

Parent, M. (2004). Automated urban vehicles: State of the art and future directions. In Proceedings of 8th International Conference on Control, Automation, Robotics and Vision, pp. 138—142.

15.

Sheikholeslam, S. and Desoer, C. (1991). Longitudinal control of a platoon of vehicles with no communication of the lead vehicle information. In Proceedings of American Control Conference, Volume 3, pp. 3102—3106.

16.

Stefan, K. (2000). Design, Simulation and Implementation of a Vision-Based Vehicle-Following System. Ph. D. thesis, Bereich 12/13 Fakultat fur Mathematik und Physik, Universität Tüubingen.

17.

Swaroop, D. and Hedrick, J.K. (1996). String stability of interconnected systems. In IEEE Transactions on Automation and Control, Volume 41(3), pp. 349—356.

18.

Swaroop, D. and Yoon, S. (1999). The design of a controller for a following vehicle in an emergency lane change maneuver. Technical Report 20 Working paper: UCB-ITS-PWP-99-3 , California Partners for Advanced Transit and Highway (PATH).

19.

Thrun, S. , Burgard, W. , and Fox, D. (2005). Probabilistic Robotics. The MIT Press.

20.

Wang, D.W. and Xu, G. (2000). Tracking stability analysis of nonholonomic wheeled mobile robots. In Proceedings of the American Control Conference, pp. 3274—3278.