{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,10,14]],"date-time":"2025-10-14T07:14:47Z","timestamp":1760426087663,"version":"build-2065373602"},"reference-count":62,"publisher":"MDPI AG","issue":"8","license":[{"start":{"date-parts":[[2022,8,22]],"date-time":"2022-08-22T00:00:00Z","timestamp":1661126400000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Entropy"],"abstract":"<jats:p>We consider the problem of optimal maneuvering, where an autonomous vehicle, an unmanned aerial vehicle (UAV) for example, must maneuver to maximize or minimize an objective function. We consider a vehicle navigating in a Global Navigation Satellite System (GNSS)-denied environment that self-localizes in two dimensions using angle-of-arrival (AOA) measurements from stationary beacons at known locations. The objective of the vehicle is to travel along the path that minimizes its position and heading estimation error. This article presents an informative path planning (IPP) algorithm that (i) uses the determinant of the self-localization estimation error covariance matrix of an unscented Kalman filter as the objective function; (ii) applies an l-step look-ahead (LSLA) algorithm to determine the optimal heading for a constant-speed vehicle. The novel algorithm takes into account the kinematic constraints of the vehicle and the AOA means of measurement. We evaluate the performance of the algorithm in five scenarios involving stationary and mobile beacons and we find the estimation error approaches the lower bound for the estimator. The simulations show the vehicle maneuvers to locations that allow for minimum estimation uncertainty, even when beacon placement is not conducive to accurate estimation.<\/jats:p>","DOI":"10.3390\/e24081169","type":"journal-article","created":{"date-parts":[[2022,8,22]],"date-time":"2022-08-22T21:30:34Z","timestamp":1661203834000},"page":"1169","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":8,"title":["Optimal Maneuvering for Autonomous Vehicle Self-Localization"],"prefix":"10.3390","volume":"24","author":[{"ORCID":"https:\/\/orcid.org\/0000-0001-9752-9346","authenticated-orcid":false,"given":"John L.","family":"McGuire","sequence":"first","affiliation":[{"name":"UniSA STEM, University of South Australia, Mawson Lakes, SA 5095, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-5665-0980","authenticated-orcid":false,"given":"Yee Wei","family":"Law","sequence":"additional","affiliation":[{"name":"UniSA STEM, University of South Australia, Mawson Lakes, SA 5095, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-3373-6295","authenticated-orcid":false,"given":"Kutluy\u0131l","family":"Do\u011fan\u00e7ay","sequence":"additional","affiliation":[{"name":"UniSA STEM, University of South Australia, Mawson Lakes, SA 5095, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Sook-Ying","family":"Ho","sequence":"additional","affiliation":[{"name":"UniSA STEM, University of South Australia, Mawson Lakes, SA 5095, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0001-6496-0543","authenticated-orcid":false,"given":"Javaan","family":"Chahl","sequence":"additional","affiliation":[{"name":"UniSA STEM, University of South Australia, Mawson Lakes, SA 5095, Australia"},{"name":"Joint and Operations Analysis Division, Defence Science and Technology Group, Melbourne, VIC 3207, Australia"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2022,8,22]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"28","DOI":"10.1109\/98.878533","article-title":"GPS-less low-cost outdoor localization for very small devices","volume":"7","author":"Bulusu","year":"2000","journal-title":"IEEE Pers. Commun."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"137","DOI":"10.1007\/s10846-008-9257-y","article-title":"Vision-based odometry and SLAM for medium and high altitude flying UAVs","volume":"54","author":"Caballero","year":"2009","journal-title":"J. Intell. Robot. Syst."},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Langelaan, J., and Rock, S. (2005, January 5\u201312). Passive GPS-free navigation for small UAVs. Proceedings of the 2005 IEEE Aerospace Conference, Big Sky, MT, USA.","DOI":"10.1109\/AERO.2005.1559602"},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"520","DOI":"10.1016\/j.robot.2010.01.006","article-title":"Reliable and efficient landmark-based localization for mobile robots","volume":"58","author":"Loevsky","year":"2010","journal-title":"Robot. Auton. Syst."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"12","DOI":"10.1186\/s40648-015-0034-y","article-title":"Self-localization method for mobile robot using acoustic beacons","volume":"2","author":"Ogiso","year":"2015","journal-title":"ROBOMECH J."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Jais, M., Ehkan, P., Ahmad, R., Ismail, I., Sabapathy, T., and Jusoh, M. (2015, January 21\u201323). Review of angle of arrival (AOA) estimations through received signal strength indication (RSSI) for wireless sensors network (WSN). Proceedings of the 2015 International Conference on Computer, Communications, and Control Technology (I4CT), Kuching, Malaysia.","DOI":"10.1109\/I4CT.2015.7219597"},{"key":"ref_7","unstructured":"Niculescu, D., and Nath, B. (April, January 30). Ad hoc positioning system (APS) using AOA. Proceedings of the IEEE INFOCOM 2003. Twenty-second Annual Joint Conference of the IEEE Computer and Communications Societies (IEEE Cat. No.03CH37428), San Francisco, CA, USA."},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"251","DOI":"10.1109\/70.563647","article-title":"Mobile robot localization using landmarks","volume":"13","author":"Betke","year":"1997","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_9","unstructured":"Esteves, J.S., Carvalho, A., and Couto, C. (2003, January 9\u201311). Generalized geometric triangulation algorithm for mobile robot absolute self-localization. Proceedings of the 2003 IEEE International Symposium on Industrial Electronics (Cat. No.03TH8692), Rio de Janeiro, Brazil."},{"key":"ref_10","doi-asserted-by":"crossref","first-page":"43773","DOI":"10.1109\/ACCESS.2019.2904725","article-title":"A node self-localization algorithm with a mobile anchor node in underwater acoustic sensor networks","volume":"7","author":"Lin","year":"2019","journal-title":"IEEE Access"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"49","DOI":"10.1007\/s11276-017-1538-6","article-title":"Anchor node path planning for localization in wireless sensor networks","volume":"25","author":"Sabale","year":"2019","journal-title":"Wirel. Netw."},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"McGuire, J., Law, Y.W., Chahl, J., and Do\u011fan\u00e7ay, K. (2021). Optimal Beacon Placement for Self-Localization Using Three Beacon Bearings. Symmetry, 13.","DOI":"10.3390\/sym13010056"},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"479","DOI":"10.1016\/j.automatica.2009.12.003","article-title":"Optimality analysis of sensor-target localization geometries","volume":"46","author":"Bishop","year":"2010","journal-title":"Automatica"},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"51","DOI":"10.3182\/20120905-3-HR-2030.00036","article-title":"Vision-based loitering over a target for a fixed-wing UAV","volume":"45","author":"Peliti","year":"2012","journal-title":"IFAC Proc. Vol."},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"833","DOI":"10.1109\/LCSYS.2018.2849559","article-title":"On Global Optimization for Informative Path Planning","volume":"2","author":"Axehill","year":"2018","journal-title":"IEEE Control Syst. Lett."},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Bostr\u00f6m-Rost, P., Axehill, D., and Hendeby, G. (2019, January 2\u20139). Informative Path Planning for Active Tracking of Agile Targets. Proceedings of the 2019 IEEE Aerospace Conference, Big Sky, MT, USA.","DOI":"10.1109\/AERO.2019.8741840"},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"889","DOI":"10.1007\/s10514-020-09903-2","article-title":"An informative path planning framework for UAV-based terrain monitoring","volume":"44","author":"Hitz","year":"2020","journal-title":"Auton. Robot."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"1500","DOI":"10.1109\/LRA.2020.2969191","article-title":"An Efficient Sampling-Based Method for Online Informative Path Planning in Unknown Environments","volume":"5","author":"Schmid","year":"2020","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Huber, M.F., Bailey, T., Durrant-Whyte, H., and Hanebeck, U.D. (2008, January 20\u201322). On entropy approximation for Gaussian mixture random vectors. Proceedings of the 2008 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems, Seoul, Korea.","DOI":"10.1109\/MFI.2008.4648062"},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Michalowicz, J.V., Nichols, J.M., and Bucholtz, F. (2013). Handbook of Differential Entropy, CRC Press.","DOI":"10.1201\/b15991"},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Wei, Y., and Zheng, R. (2020, January 6\u20139). Informative Path Planning for Mobile Sensing with Reinforcement Learning. Proceedings of the IEEE INFOCOM 2020-IEEE Conference on Computer Communications, Toronto, ON, Canada.","DOI":"10.1109\/INFOCOM41043.2020.9155528"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"1271","DOI":"10.1177\/0278364914533443","article-title":"Sampling-based robotic information gathering algorithms","volume":"33","author":"Hollinger","year":"2014","journal-title":"Int. J. Robot. Res."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"1248","DOI":"10.1016\/j.sigpro.2007.11.013","article-title":"Optimal angular sensor separation for AOA localization","volume":"88","author":"Hmam","year":"2008","journal-title":"Signal Process."},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"311","DOI":"10.1016\/j.inffus.2012.02.005","article-title":"Information geometry of target tracking sensor networks","volume":"14","author":"Cheng","year":"2013","journal-title":"Inf. Fusion"},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"892","DOI":"10.1109\/7.784059","article-title":"Optimization of observer trajectories for bearings-only target localization","volume":"35","author":"Oshman","year":"1999","journal-title":"IEEE Trans. Aerosp. Electron. Syst."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"32","DOI":"10.1109\/TAC.2009.2034206","article-title":"Mobile sensor network control using mutual information methods and particle filters","volume":"55","author":"Hoffmann","year":"2010","journal-title":"IEEE Trans. Autom. Control"},{"key":"ref_27","unstructured":"Grocholsky, B., Makarenko, A., and Durrant-Whyte, H. (2003, January 14\u201319). Information-theoretic coordinated control of multiple sensor platforms. Proceedings of the 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422), Taipei, Taiwan."},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"777","DOI":"10.1109\/7.705885","article-title":"Optimal observer maneuver for bearings-only tracking","volume":"34","author":"Passerieux","year":"1998","journal-title":"IEEE Trans. Aerosp. Electron. Syst."},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"661","DOI":"10.1016\/j.automatica.2005.12.018","article-title":"Optimal sensor placement and motion coordination for target tracking","volume":"42","author":"Bullo","year":"2006","journal-title":"Automatica"},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"12117","DOI":"10.3182\/20080706-5-KR-1001.02052","article-title":"Optimal Trajectories for Homing Navigation with Bearing Measurements","volume":"41","author":"Bishop","year":"2008","journal-title":"IFAC Proc. Vol."},{"key":"ref_31","unstructured":"Do\u011fan\u00e7ay, K. (2010, January 23\u201327). Single- and multi-platform constrained sensor path optimization for angle-of-arrival target tracking. Proceedings of the 2010 18th European Signal Processing Conference, Aalborg, Denmark."},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"1025","DOI":"10.1109\/LRA.2018.2794608","article-title":"Anytime Planning for Decentralized Multirobot Active Information Gathering","volume":"3","author":"Schlotfeldt","year":"2018","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"106","DOI":"10.1134\/S0005117916010069","article-title":"Moving observer trajectory control by angular measurements in tracking problem","volume":"77","author":"Andreev","year":"2016","journal-title":"Autom. Remote Control"},{"key":"ref_34","doi-asserted-by":"crossref","unstructured":"Galyaev, A.A., Lysenko, P.V., and Rubinovich, E.Y. (2021). Optimal stochastic control in the interception problem of a randomly tacking vehicle. Mathematics, 9.","DOI":"10.3390\/math9192386"},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"012160","DOI":"10.1088\/1742-6596\/1828\/1\/012160","article-title":"Optimal guidance law for intercepting the active defense aircraft with terminal angle constraint","volume":"1828","author":"Zhang","year":"2021","journal-title":"J. Phys. Conf. Ser."},{"key":"ref_36","doi-asserted-by":"crossref","unstructured":"Papachristos, C., Khattak, S., and Alexis, K. (June, January 29). Uncertainty-aware receding horizon exploration and mapping using aerial robots. Proceedings of the 2017 IEEE International Conference on Robotics and Automation (ICRA), Singapore.","DOI":"10.1109\/ICRA.2017.7989531"},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"247","DOI":"10.1109\/JSTSP.2014.2387101","article-title":"Greedy Motion Planning for Simultaneous Signal Landscape Mapping and Receiver Localization","volume":"9","author":"Kassas","year":"2015","journal-title":"IEEE J. Sel. Top. Signal Process."},{"key":"ref_38","doi-asserted-by":"crossref","unstructured":"Xu, S., Do\u011fan\u00e7ay, K., and Hmam, H. (2016, January 20\u201325). Distributed path optimization of multiple UAVs for AOA target localization. Proceedings of the 2016 IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP), Shanghai, China.","DOI":"10.1109\/ICASSP.2016.7472256"},{"key":"ref_39","unstructured":"Hernandez, M.L. (July, January 28). Optimal sensor trajectories in bearings-only tracking. Proceedings of the Seventh International Conference on Information Fusion, Stockholm, Sweden."},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"308","DOI":"10.1002\/rob.20285","article-title":"Differentially constrained mobile robot motion planning in state lattices","volume":"26","author":"Pivtoraiko","year":"2009","journal-title":"J. Field Robot."},{"key":"ref_41","unstructured":"Papadimitriou, C.H., and Steiglitz, K. (1998). Combinatorial Optimization: Algorithms and Complexity, Dover Publications."},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"2482","DOI":"10.1016\/j.automatica.2012.06.092","article-title":"On efficient sensor scheduling for linear dynamical systems","volume":"48","author":"Vitus","year":"2012","journal-title":"Automatica"},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"70117","DOI":"10.1109\/ACCESS.2019.2918299","article-title":"Optimal configuration analysis of AOA localization and optimal heading angles generation method for UAV swarms","volume":"7","author":"Wang","year":"2019","journal-title":"IEEE Access"},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Lozano, J.A., Larra\u00f1aga, P., Inza, I., and Bengoetxea, E. (2006). The CMA Evolution Strategy: A Comparing Review. Towards a New Evolutionary Computation: Advances in the Estimation of Distribution Algorithms, Springer.","DOI":"10.1007\/3-540-32494-1"},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"146","DOI":"10.1016\/j.oceaneng.2016.07.028","article-title":"Optimal design of the own ship maneuver in the bearing-only target motion analysis problem using a heuristically supervised extended Kalman filter","volume":"123","author":"Sabet","year":"2016","journal-title":"Ocean Eng."},{"key":"ref_46","doi-asserted-by":"crossref","first-page":"582","DOI":"10.1016\/j.dt.2019.04.011","article-title":"A review: On path planning strategies for navigation of mobile robot","volume":"15","author":"Patle","year":"2019","journal-title":"Def. Technol."},{"key":"ref_47","doi-asserted-by":"crossref","first-page":"1235","DOI":"10.1080\/002071700417876","article-title":"Optimal sensor location for parameter estimation of distributed processes","volume":"73","author":"Ucinski","year":"2000","journal-title":"Int. J. Control"},{"key":"ref_48","doi-asserted-by":"crossref","unstructured":"Zhang, H., Dufour, F., Anselmi, J., Laneuville, D., and N\u00e8gre, A. (2018, January 3\u201310). Piecewise optimal trajectories of observer for bearings-only tracking of maneuvering target. Proceedings of the 2018 IEEE Aerospace Conference, Big Sky, MT, USA.","DOI":"10.1109\/AERO.2018.8396474"},{"key":"ref_49","unstructured":"McGuire, J., Law, Y.W., and Chahl, J. (December, January 29). Mobile beacon path planning for optimal unmanned aerial vehicle self-localization. Proceedings of the AIAC 2021: 19th Australian International Aerospace Congress. Engineers Australia, Melbourne, VIC, Australia."},{"key":"ref_50","doi-asserted-by":"crossref","unstructured":"Roh, H., Cho, M.H., and Tahk, M.J. (2018, January 8\u201312). Trajectory optimization using Cram\u00e9r-Rao lower bound for bearings-only target tracking. Proceedings of the 2018 AIAA Guidance, Navigation, and Control Conference, Kissimmee, FL, USA.","DOI":"10.2514\/6.2018-1591"},{"key":"ref_51","doi-asserted-by":"crossref","first-page":"10386","DOI":"10.3390\/s130810386","article-title":"Sensor networks for optimal target localization with bearings-only measurements in constrained three-dimensional scenarios","volume":"13","author":"Pascoal","year":"2013","journal-title":"Sensors"},{"key":"ref_52","doi-asserted-by":"crossref","first-page":"1196","DOI":"10.1109\/TAES.2017.2667999","article-title":"Optimal sensor placement for 3-D angle-of-arrival target localization","volume":"53","author":"Xu","year":"2017","journal-title":"IEEE Trans. Aerosp. Electron. Syst."},{"key":"ref_53","doi-asserted-by":"crossref","unstructured":"Ucinski, D. (2004). Optimal Measurement Methods for Distributed Parameter System Identification, CRC Press.","DOI":"10.1201\/9780203026786"},{"key":"ref_54","doi-asserted-by":"crossref","first-page":"35","DOI":"10.1115\/1.3662552","article-title":"A new approach to linear filtering and prediction problems","volume":"82","author":"Kalman","year":"1960","journal-title":"J. Basic Eng."},{"key":"ref_55","doi-asserted-by":"crossref","unstructured":"Julier, S.J., and Uhlmann, J.K. (1997, January 21\u201325). New extension of the Kalman filter to nonlinear systems. Proceedings of the Signal Processing, Sensor Fusion, and Target Recognition VI, Orlando, FL, USA.","DOI":"10.1117\/12.280797"},{"key":"ref_56","unstructured":"Kay, S.M. (1993). Fundamentals of Statistical Signal Processing, Prentice Hall PTR."},{"key":"ref_57","doi-asserted-by":"crossref","first-page":"1166","DOI":"10.1109\/JPROC.2018.2828858","article-title":"Received-signal-strength-based localization in wireless sensor networks","volume":"106","author":"Niu","year":"2018","journal-title":"Proc. IEEE"},{"key":"ref_58","doi-asserted-by":"crossref","unstructured":"Spagnolini, U. (2018). Statistical Signal Processing in Engineering, John Wiley & Sons Ltd.","DOI":"10.1002\/9781119294016"},{"key":"ref_59","doi-asserted-by":"crossref","first-page":"1386","DOI":"10.1109\/78.668800","article-title":"Posterior Cram\u00e9r-Rao bounds for discrete-time nonlinear filtering","volume":"46","author":"Tichavsky","year":"1998","journal-title":"IEEE Trans. Signal Process."},{"key":"ref_60","unstructured":"Van Trees, H.L. (2004). Detection, Estimation, and Modulation Theory, Part I: Detection, Estimation, and Linear Modulation Theory, John Wiley & Sons."},{"key":"ref_61","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1109\/TSP.2010.2080268","article-title":"Conditional posterior Cram\u00e9r\u2013Rao lower bounds for nonlinear sequential Bayesian estimation","volume":"59","author":"Zuo","year":"2010","journal-title":"IEEE Trans. Signal Process."},{"key":"ref_62","unstructured":"Lu, S., Cai, L., Ding, L., and Chen, J. (June, January 30). Two Efficient Implementation Forms of Unscented Kalman Filter. Proceedings of the 2007 IEEE International Conference on Control and Automation, Guangzhou, China."}],"container-title":["Entropy"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1099-4300\/24\/8\/1169\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T00:13:40Z","timestamp":1760141620000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1099-4300\/24\/8\/1169"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2022,8,22]]},"references-count":62,"journal-issue":{"issue":"8","published-online":{"date-parts":[[2022,8]]}},"alternative-id":["e24081169"],"URL":"https:\/\/doi.org\/10.3390\/e24081169","relation":{},"ISSN":["1099-4300"],"issn-type":[{"type":"electronic","value":"1099-4300"}],"subject":[],"published":{"date-parts":[[2022,8,22]]}}}