{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,9,24]],"date-time":"2026-09-24T05:01:14Z","timestamp":1790226074075,"version":"4.1.0"},"reference-count":84,"publisher":"MDPI AG","issue":"18","license":[{"start":{"date-parts":[[2026,9,21]],"date-time":"2026-09-21T00:00:00Z","timestamp":1789948800000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"name":"Institute of Information &amp; Communications Technology Planning &amp; Evaluation","award":["RS-2023-00244929"],"award-info":[{"award-number":["RS-2023-00244929"]}],"id":[{"id":"https:\/\/ror.org\/01g0hqq23","id-type":"ROR","asserted-by":"crossref"}]},{"award":["RS-2023-00244929"],"award-info":[{"award-number":["RS-2023-00244929"]}],"id":[{"id":"https:\/\/ror.org\/01g0hqq23","id-type":"ROR","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>The conventional autonomy stack layers separate representations, leaving a vertical gap between high-level semantic reasoning and low-level trajectory generation. This paper closes that gap by carrying a single Triplet Ontological Semantic Model (TOSM) representation across the stack. A standardized high-definition (HD) map is first lifted into a TOSM-based semantic HD map with symbolic, explicit, and implicit attributes. Semantic Web Rule Language (SWRL) rules then infer context-appropriate maneuvers such as yielding, stopping, and lane changing. The inferred state is translated automatically into a Planning Domain Definition Language (PDDL) mission plan, and the same representation drives a Gaussian-process factor-graph optimizer that produces a smooth, kinematically feasible trajectory. The optimizer reuses the incremental factor graph of the localization layer, and semantic lane and interaction factors tie the trajectory directly to the map. Reasoning, planning, and optimization therefore share one interpretable representation, and every inferred maneuver remains traceable to the trajectory that realizes it. The rule base is logically consistent and agrees with an independent description-logic reasoner. In a closed-loop drive-along on urban routes, the optimizer tracks the routed lane far more tightly than a diverse set of baselines while remaining smooth and feasible. An open-loop evaluation on real driving data recorded in Busan, Republic of Korea, reproduces this advantage against an untuned continuous-optimization baseline.<\/jats:p>","DOI":"10.3390\/s26185973","type":"journal-article","created":{"date-parts":[[2026,9,22]],"date-time":"2026-09-22T10:21:48Z","timestamp":1790072508000},"page":"5973","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":0,"title":["Unified Semantic Reasoning and Planning for Autonomous Driving"],"prefix":"10.3390","volume":"26","author":[{"ORCID":"https:\/\/orcid.org\/0000-0003-2842-3841","authenticated-orcid":false,"given":"Ye-Chan","family":"An","sequence":"first","affiliation":[{"name":"Department of Electrical and Computer Engineering, College of Information and Communication Engineering, Sungkyunkwan University, Suwon 16419, Republic of Korea"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-2715-4865","authenticated-orcid":false,"given":"Jun-Hyeon","family":"Choi","sequence":"additional","affiliation":[{"name":"Department of Electrical and Computer Engineering, College of Information and Communication Engineering, Sungkyunkwan University, Suwon 16419, Republic of Korea"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-1676-7575","authenticated-orcid":false,"given":"Jeong-Won","family":"Pyo","sequence":"additional","affiliation":[{"name":"DXR Co., Ltd., R&D Center, Seoul 01411, Republic of Korea"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-8447-9252","authenticated-orcid":false,"given":"Sang-Hyeon","family":"Bae","sequence":"additional","affiliation":[{"name":"Samsung Display Co., Ltd., R&D Center, Yongin 17113, Republic of Korea"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-5816-0088","authenticated-orcid":false,"given":"Tae-Yong","family":"Kuc","sequence":"additional","affiliation":[{"name":"Department of Electrical and Computer Engineering, College of Information and Communication Engineering, Sungkyunkwan University, Suwon 16419, Republic of Korea"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2026,9,21]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"33","DOI":"10.1109\/TIV.2016.2578706","article-title":"A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles","volume":"1","author":"Paden","year":"2016","journal-title":"IEEE Trans. Intell. Veh."},{"key":"ref_2","unstructured":"Bojarski, M., Del Testa, D., Dworakowski, D., Firner, B., Flepp, B., Goyal, P., Jackel, L.D., Monfort, M., Muller, U., and Zhang, J. (2016). End to End Learning for Self-Driving Cars. arXiv."},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Hu, Y., Yang, J., Chen, L., Li, K., Sima, C., Zhu, X., Chai, S., Du, S., Lin, T., and Wang, W. (2023, January 17\u201324). Planning-Oriented Autonomous Driving. Proceedings of the IEEE\/CVF Conference on Computer Vision and Pattern Recognition (CVPR), Vancouver, BC, Canada.","DOI":"10.1109\/CVPR52729.2023.01712"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Joo, S., Bae, S., Choi, J., Park, H., Lee, S., You, S., Uhm, T., Moon, J., and Kuc, T. (2022). A Flexible Semantic Ontological Model Framework and Its Application to Robotic Navigation in Large Dynamic Environments. Electronics, 11.","DOI":"10.3390\/electronics11152420"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Bae, S., Joo, S., Choi, J., Pyo, J., Park, H., and Kuc, T. (2023). Semantic Knowledge-Based Hierarchical Planning Approach for Multi-Robot Systems. Electronics, 12.","DOI":"10.3390\/electronics12092131"},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Pyo, J.-W., Choi, J.-H., and Kuc, T.-Y. (2024). An Object-Centric Hierarchical Pose Estimation Method Using Semantic High-Definition Maps for General Autonomous Driving. Sensors, 24.","DOI":"10.3390\/s24165191"},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Choi, J.-H., Seo, D.-S., An, Y.-C., Eum, T.-W., Kim, J.-H., Kwon, G.-H., and Pyo, J.-W. (2026). Context-Aware Semantic Localization with Adaptive Sensor Fusion Under Adverse Conditions. Sensors, 26.","DOI":"10.3390\/s26041328"},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"269","DOI":"10.1007\/BF01386390","article-title":"A Note on Two Problems in Connexion with Graphs","volume":"1","author":"Dijkstra","year":"1959","journal-title":"Numer. Math."},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"100","DOI":"10.1109\/TSSC.1968.300136","article-title":"A Formal Basis for the Heuristic Determination of Minimum Cost Paths","volume":"4","author":"Hart","year":"1968","journal-title":"IEEE Trans. Syst. Sci. Cybern."},{"key":"ref_10","unstructured":"LaValle, S.M. (1998). Rapidly-Exploring Random Trees: A New Tool for Path Planning, Computer Science Department, Iowa State University. Research Report 9811."},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"846","DOI":"10.1177\/0278364911406761","article-title":"Sampling-Based Algorithms for Optimal Motion Planning","volume":"30","author":"Karaman","year":"2011","journal-title":"Int. J. Robot. Res."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"485","DOI":"10.1177\/0278364909359210","article-title":"Path Planning for Autonomous Vehicles in Unknown Semi-structured Environments","volume":"29","author":"Dolgov","year":"2010","journal-title":"Int. J. Robot. Res."},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"566","DOI":"10.1109\/TCST.2007.894653","article-title":"Predictive Active Steering Control for Autonomous Vehicle Systems","volume":"15","author":"Falcone","year":"2007","journal-title":"IEEE Trans. Control Syst. Technol."},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"2184","DOI":"10.1109\/TII.2024.3495763","article-title":"Secure Observer-Based Collision-Free Control for Autonomous Vehicles Under Non-Gaussian Noises","volume":"21","author":"Zhu","year":"2025","journal-title":"IEEE Trans. Ind. Inform."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Sun, W., Lin, X., Shi, Y., Zhang, C., Wu, H., and Zheng, S. (2025, January 19\u201323). SparseDrive: End-to-End Autonomous Driving via Sparse Scene Representation. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Atlanta, GA, USA.","DOI":"10.1109\/ICRA55743.2025.11128800"},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"10164","DOI":"10.1109\/TPAMI.2024.3435937","article-title":"End-to-End Autonomous Driving: Challenges and Frontiers","volume":"46","author":"Chen","year":"2024","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"191","DOI":"10.1016\/S0004-3702(00)00017-5","article-title":"The Spatial Semantic Hierarchy","volume":"119","author":"Kuipers","year":"2000","journal-title":"Artif. Intell."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"492","DOI":"10.1109\/TSMCA.2010.2076404","article-title":"Ontology-Based Unified Robot Knowledge for Service Robots in Indoor Environments","volume":"41","author":"Lim","year":"2011","journal-title":"IEEE Trans. Syst. Man Cybern. A Syst. Hum."},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"69","DOI":"10.1109\/MRA.2011.941632","article-title":"RoboEarth\u2014A World Wide Web for Robots","volume":"18","author":"Waibel","year":"2011","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_20","unstructured":"World Wide Web Consortium (2026, August 19). OWL 2 Web Ontology Language Document Overview; W3C Recommendation. Available online: https:\/\/www.w3.org\/TR\/owl2-overview\/."},{"key":"ref_21","first-page":"1","article-title":"SWRL: A Semantic Web Rule Language Combining OWL and RuleML","volume":"21","author":"Horrocks","year":"2004","journal-title":"W3C Memb. Submiss."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"51","DOI":"10.1016\/j.websem.2007.03.004","article-title":"Pellet: A Practical OWL-DL Reasoner","volume":"5","author":"Sirin","year":"2007","journal-title":"J. Web Semant."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"11","DOI":"10.1016\/j.artmed.2017.07.002","article-title":"Owlready: Ontology-Oriented Programming in Python with Automatic Classification and High Level Constructs for Biomedical Ontologies","volume":"80","author":"Lamy","year":"2017","journal-title":"Artif. Intell. Med."},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Manzoor, S., Rocha, Y.G., Joo, S.-H., Bae, S.-H., Kim, E.-J., Joo, K.-J., and Kuc, T.-Y. (2021). Ontology-Based Knowledge Representation in Robotic Systems: A Survey Oriented Toward Applications. Appl. Sci., 11.","DOI":"10.3390\/app11104324"},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"46","DOI":"10.1109\/2.30720","article-title":"Using Occupancy Grids for Mobile Robot Perception and Navigation","volume":"22","author":"Elfes","year":"1989","journal-title":"Computer"},{"key":"ref_26","doi-asserted-by":"crossref","unstructured":"Smith, R., Self, M., and Cheeseman, P. (1990). Estimating Uncertain Spatial Relationships in Robotics. Autonomous Robot Vehicles, Springer.","DOI":"10.1007\/978-1-4613-8997-2_14"},{"key":"ref_27","doi-asserted-by":"crossref","first-page":"1309","DOI":"10.1109\/TRO.2016.2624754","article-title":"Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age","volume":"32","author":"Cadena","year":"2016","journal-title":"IEEE Trans. Robot."},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Poggenhans, F., Pauls, J.-H., Janosovits, J., Orf, S., Naumann, M., Kuhnt, F., and Mayr, M. (2018, January 4\u20137). Lanelet2: A High-Definition Map Framework for the Future of Automated Driving. Proceedings of the 21st International Conference on Intelligent Transportation Systems (ITSC), Maui, HI, USA.","DOI":"10.1109\/ITSC.2018.8569929"},{"key":"ref_29","unstructured":"(2026, August 19). ASAM e.V. ASAM OpenDRIVE 1.7 Specification. Available online: https:\/\/www.asam.net\/standards\/detail\/opendrive\/."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"324","DOI":"10.1017\/S0373463319000638","article-title":"High Definition Map for Automated Driving: Overview and Analysis","volume":"73","author":"Liu","year":"2020","journal-title":"J. Navig."},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Chen, P., Luo, Z., Jiang, X., Yin, Z., and Li, J. (2025). Maps for Autonomous Driving: Full-Process Survey and Frontiers. arXiv.","DOI":"10.3389\/fphy.2024.1485026"},{"key":"ref_32","unstructured":"Liao, B., Chen, S., Wang, X., Cheng, T., Zhang, Q., Liu, W., and Huang, C. (2023, January 1\u20135). MapTR: Structured Modeling and Learning for Online Vectorized HD Map Construction. Proceedings of the International Conference on Learning Representations (ICLR), Kigali, Rwanda."},{"key":"ref_33","doi-asserted-by":"crossref","unstructured":"Li, Q., Wang, Y., Wang, Y., and Zhao, H. (2022, January 23\u201327). HDMapNet: An Online HD Map Construction and Evaluation Framework. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Philadelphia, PA, USA.","DOI":"10.1109\/ICRA46639.2022.9812383"},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"1352","DOI":"10.1007\/s11263-024-02235-z","article-title":"MapTRv2: An End-to-End Framework for Online Vectorized HD Map Construction","volume":"133","author":"Liao","year":"2025","journal-title":"Int. J. Comput. Vis."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1561\/2300000059","article-title":"Semantics for Robotic Mapping, Perception and Interaction: A Survey","volume":"8","author":"Garg","year":"2020","journal-title":"Found. Trends Robot."},{"key":"ref_36","unstructured":"McCormac, J., Handa, A., Davison, A., and Leutenegger, S. (June, January 29). SemanticFusion: Dense 3D Semantic Mapping with Convolutional Neural Networks. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Singapore."},{"key":"ref_37","doi-asserted-by":"crossref","unstructured":"Chen, X., Milioto, A., Palazzolo, E., Giguere, P., Behley, J., and Stachniss, C. (2019, January 4\u20138). SuMa++: Efficient LiDAR-Based Semantic SLAM. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China.","DOI":"10.1109\/IROS40897.2019.8967704"},{"key":"ref_38","doi-asserted-by":"crossref","unstructured":"Dube, R., Cramariuc, A., Dugas, D., Nieto, J., Siegwart, R., and Cadena, C. (2018). SegMap: 3D Segment Mapping Using Data-Driven Descriptors. arXiv.","DOI":"10.15607\/RSS.2018.XIV.003"},{"key":"ref_39","doi-asserted-by":"crossref","unstructured":"Galindo, C., Saffiotti, A., Coradeschi, S., Buschka, P., Fernandez-Madrigal, J.-A., and Gonzalez, J. (2005, January 19\u201325). Multi-Hierarchical Semantic Maps for Mobile Robotics. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Hangzhou, China.","DOI":"10.1109\/IROS.2005.1545511"},{"key":"ref_40","doi-asserted-by":"crossref","unstructured":"Pronobis, A., and Jensfelt, P. (2012, January 14\u201318). Large-Scale Semantic Mapping and Reasoning with Heterogeneous Modalities. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Saint Paul, MN, USA.","DOI":"10.1109\/ICRA.2012.6224637"},{"key":"ref_41","doi-asserted-by":"crossref","unstructured":"Huang, L., Liang, H., Yu, B., Li, B., and Zhu, H. (2019, January 13\u201315). Ontology-Based Driving Scene Modeling, Situation Assessment and Decision Making for Autonomous Vehicles. Proceedings of the 4th Asia-Pacific Conference on Intelligent Robot Systems (ACIRS), Nagoya, Japan.","DOI":"10.1109\/ACIRS.2019.8935984"},{"key":"ref_42","doi-asserted-by":"crossref","unstructured":"Armand, A., Filliat, D., and Ib\u00e1\u00f1ez-Guzm\u00e1n, J. (2014, January 8\u201311). Ontology-Based Context Awareness for Driving Assistance Systems. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Dearborn, MI, USA.","DOI":"10.1109\/IVS.2014.6856509"},{"key":"ref_43","doi-asserted-by":"crossref","unstructured":"Wu, X. (2024). An Ontology-Based Vehicle Behavior Prediction Method Incorporating Vehicle Light Signal Detection. Sensors, 24.","DOI":"10.3390\/s24196459"},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Guan, L., Valmeekam, K., Sreedharan, S., and Kambhampati, S. (2023). Leveraging Pre-Trained Large Language Models to Construct and Utilize World Models for Model-Based Task Planning. Advances in Neural Information Processing Systems (NeurIPS), Curran Associates, Inc.","DOI":"10.52202\/075280-3459"},{"key":"ref_45","unstructured":"Tian, X., Gu, J., Li, B., Liu, Y., Wang, Y., Zhao, Z., Zhan, K., Jia, P., Lang, X., and Zhao, H. (2024). DriveVLM: The Convergence of Autonomous Driving and Large Vision-Language Models. arXiv."},{"key":"ref_46","doi-asserted-by":"crossref","first-page":"125914","DOI":"10.1016\/j.eswa.2024.125914","article-title":"RAG-Based Explainable Prediction of Road Users Behaviors for Automated Driving Using Knowledge Graphs and Large Language Models","volume":"265","author":"Melo","year":"2025","journal-title":"Expert Syst. Appl."},{"key":"ref_47","doi-asserted-by":"crossref","unstructured":"Censi, A., Slutsky, K., Wongpiromsarn, T., Yershov, D., Pendleton, S., Fu, J., and Frazzoli, E. (2019, January 20\u201324). Liability, Ethics, and Culture-Aware Behavior Specification Using Rulebooks. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Montreal, QC, Canada.","DOI":"10.1109\/ICRA.2019.8794364"},{"key":"ref_48","doi-asserted-by":"crossref","unstructured":"Rizaldi, A., and Althoff, M. (2015, January 15\u201318). Formalising Traffic Rules for Accountability of Autonomous Vehicles. Proceedings of the IEEE International Conference on Intelligent Transportation Systems (ITSC), Las Palmas de Gran Canaria, Spain.","DOI":"10.1109\/ITSC.2015.269"},{"key":"ref_49","doi-asserted-by":"crossref","first-page":"189","DOI":"10.1016\/0004-3702(71)90010-5","article-title":"STRIPS: A New Approach to the Application of Theorem Proving to Problem Solving","volume":"2","author":"Fikes","year":"1971","journal-title":"Artif. Intell."},{"key":"ref_50","unstructured":"McDermott, D., Ghallab, M., Howe, A., Knoblock, C., Ram, A., Veloso, M., Weld, D., and Wilkins, D. (1998). PDDL\u2014The Planning Domain Definition Language, Yale Center for Computational Vision and Control. Technical Report TR-98-003."},{"key":"ref_51","doi-asserted-by":"crossref","first-page":"191","DOI":"10.1613\/jair.1705","article-title":"The Fast Downward Planning System","volume":"26","author":"Helmert","year":"2006","journal-title":"J. Artif. Intell. Res."},{"key":"ref_52","doi-asserted-by":"crossref","unstructured":"Helmert, M., and Domshlak, C. (2009, January 19\u201323). Landmarks, Critical Paths and Abstractions: What\u2019s the Difference Anyway?. Proceedings of the 19th International Conference on Automated Planning and Scheduling (ICAPS), Thessaloniki, Greece.","DOI":"10.1609\/icaps.v19i1.13370"},{"key":"ref_53","unstructured":"Chen, C., Gaschler, A., Rickert, M., and Knoll, A. (July, January 28). Task Planning for Highly Automated Driving. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Seoul, Republic of Korea."},{"key":"ref_54","doi-asserted-by":"crossref","first-page":"235","DOI":"10.1613\/jair.2044","article-title":"Modelling Mixed Discrete-Continuous Domains for Planning","volume":"27","author":"Fox","year":"2006","journal-title":"J. Artif. Intell. Res."},{"key":"ref_55","doi-asserted-by":"crossref","unstructured":"Cashmore, M., Fox, M., Long, D., Magazzeni, D., Ridder, B., Carrera, A., Palomeras, N., Hurtos, N., and Carreras, M. (2015, January 7\u201311). ROSPlan: Planning in the Robot Operating System. Proceedings of the International Conference on Automated Planning and Scheduling (ICAPS), Jerusalem, Israel.","DOI":"10.1609\/icaps.v25i1.13699"},{"key":"ref_56","doi-asserted-by":"crossref","unstructured":"Ratliff, N., Zucker, M., Bagnell, J.A., and Srinivasa, S. (2009, January 12\u201317). CHOMP: Gradient Optimization Techniques for Efficient Motion Planning. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Kobe, Japan.","DOI":"10.1109\/ROBOT.2009.5152817"},{"key":"ref_57","doi-asserted-by":"crossref","unstructured":"Xiong, L., Fu, Z., Zeng, D., and Leng, B. (2021). An Optimized Trajectory Planner and Motion Controller Framework for Autonomous Driving in Unstructured Environments. Sensors, 21.","DOI":"10.3390\/s21134409"},{"key":"ref_58","unstructured":"Dong, J., Mukadam, M., Dellaert, F., and Boots, B. (2016, January 18\u201322). Motion Planning as Probabilistic Inference Using Gaussian Processes and Factor Graphs. Proceedings of the Robotics: Science and Systems 2016, Ann Arbor, MI, USA."},{"key":"ref_59","doi-asserted-by":"crossref","first-page":"1319","DOI":"10.1177\/0278364918790369","article-title":"Continuous-Time Gaussian Process Motion Planning via Probabilistic Inference","volume":"37","author":"Mukadam","year":"2018","journal-title":"Int. J. Robot. Res."},{"key":"ref_60","doi-asserted-by":"crossref","first-page":"216","DOI":"10.1177\/0278364911430419","article-title":"iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree","volume":"31","author":"Kaess","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_61","doi-asserted-by":"crossref","first-page":"1181","DOI":"10.1177\/0278364906072768","article-title":"Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing","volume":"25","author":"Dellaert","year":"2006","journal-title":"Int. J. Robot. Res."},{"key":"ref_62","unstructured":"Dellaert, F. (2012). Factor Graphs and GTSAM: A Hands-on Introduction, Georgia Institute of Technology. Technical Report GT-RIM-CP&R-2012-002."},{"key":"ref_63","doi-asserted-by":"crossref","unstructured":"King-Smith, M., Tsiotras, P., and Dellaert, F. (2022, January 23\u201327). Simultaneous Control and Trajectory Estimation for Collision Avoidance of Autonomous Robotic Spacecraft Systems. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Philadelphia, PA, USA.","DOI":"10.1109\/ICRA46639.2022.9811875"},{"key":"ref_64","doi-asserted-by":"crossref","first-page":"415","DOI":"10.1007\/s10514-018-9770-1","article-title":"STEAP: Simultaneous Trajectory Estimation and Planning","volume":"43","author":"Mukadam","year":"2019","journal-title":"Auton. Robot."},{"key":"ref_65","doi-asserted-by":"crossref","first-page":"72","DOI":"10.1109\/LRA.2024.3504239","article-title":"A Real-Time Spatio-Temporal Trajectory Planner for Autonomous Vehicles with Semantic Graph Optimization","volume":"10","author":"He","year":"2025","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_66","doi-asserted-by":"crossref","unstructured":"Cheng, J., Chen, Y., Zhang, Q., Gan, L., Liu, C., and Liu, M. (2022, January 23\u201327). Real-Time Trajectory Planning for Autonomous Driving with Gaussian Process and Incremental Refinement. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Philadelphia, PA, USA.","DOI":"10.1109\/ICRA46639.2022.9812405"},{"key":"ref_67","doi-asserted-by":"crossref","first-page":"380","DOI":"10.1109\/OJITS.2024.3418956","article-title":"Factor Graph-Based Planning as Inference for Autonomous Vehicle Racing","volume":"5","author":"Bari","year":"2024","journal-title":"IEEE Open J. Intell. Transp. Syst."},{"key":"ref_68","doi-asserted-by":"crossref","first-page":"2997","DOI":"10.1109\/LRA.2019.2923954","article-title":"Safe Trajectory Generation for Complex Urban Environments Using Spatio-Temporal Semantic Corridor","volume":"4","author":"Ding","year":"2019","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_69","doi-asserted-by":"crossref","first-page":"1118","DOI":"10.1109\/TRO.2021.3104254","article-title":"EPSILON: An Efficient Planning System for Automated Vehicles in Highly Interactive Environments","volume":"38","author":"Ding","year":"2022","journal-title":"IEEE Trans. Robot."},{"key":"ref_70","doi-asserted-by":"crossref","unstructured":"Lidard, J., Hu, H., Hancock, A., Zhang, Z., Gim\u00f3 Contreras, A., Modi, V., DeCastro, J., Gopinath, D., Rosman, G., and Leonard, N.E. (2024). Blending Data-Driven Priors in Dynamic Games. arXiv.","DOI":"10.15607\/RSS.2024.XX.020"},{"key":"ref_71","doi-asserted-by":"crossref","first-page":"1367","DOI":"10.1007\/s10514-017-9619-z","article-title":"Multipolicy Decision-Making for Autonomous Driving via Changepoint-Based Behavior Prediction: Theory and Experiment","volume":"41","author":"Galceran","year":"2017","journal-title":"Auton. Robot."},{"key":"ref_72","doi-asserted-by":"crossref","first-page":"253","DOI":"10.1613\/jair.855","article-title":"The FF Planning System: Fast Plan Generation Through Heuristic Search","volume":"14","author":"Hoffmann","year":"2001","journal-title":"J. Artif. Intell. Res."},{"key":"ref_73","doi-asserted-by":"crossref","unstructured":"Barfoot, T.D., Tong, C.H., and Sarkka, S. (2014, January 12). Batch Continuous-Time Trajectory Estimation as Exactly Sparse Gaussian Process Regression. Proceedings of the Robotics: Science and Systems (RSS) 2014, Berkeley, CA, USA.","DOI":"10.15607\/RSS.2014.X.001"},{"key":"ref_74","unstructured":"(1997). Mechanical Vibration and Shock\u2014Evaluation of Human Exposure to Whole-Body Vibration\u2014Part 1: General Requirements (Standard No. ISO 2631-1)."},{"key":"ref_75","unstructured":"Kong, J., Pfeiffer, M., Schildbach, G., and Borrelli, F. (July, January 28). Kinematic and Dynamic Vehicle Models for Autonomous Driving Control Design. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Seoul, Republic of Korea."},{"key":"ref_76","doi-asserted-by":"crossref","first-page":"594","DOI":"10.1109\/LRA.2019.2891492","article-title":"A White-Noise-on-Jerk Motion Prior for Continuous-Time Trajectory Estimation on SE(3)","volume":"4","author":"Tang","year":"2019","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_77","unstructured":"Werling, M., Ziegler, J., Kammel, S., and Thrun, S. (2010, January 3\u20138). Optimal Trajectory Generation for Dynamic Street Scenarios in a Fren\u00e9t Frame. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Anchorage, AK, USA."},{"key":"ref_78","doi-asserted-by":"crossref","first-page":"24972","DOI":"10.1073\/pnas.1820676116","article-title":"Social Behavior for Autonomous Vehicles","volume":"116","author":"Schwarting","year":"2019","journal-title":"Proc. Natl. Acad. Sci. USA"},{"key":"ref_79","doi-asserted-by":"crossref","first-page":"1805","DOI":"10.1103\/PhysRevE.62.1805","article-title":"Congested Traffic States in Empirical Observations and Microscopic Simulations","volume":"62","author":"Treiber","year":"2000","journal-title":"Phys. Rev. E"},{"key":"ref_80","unstructured":"(2018). Intelligent Transport Systems\u2014Adaptive Cruise Control Systems\u2014Performance Requirements and Test Procedures (Standard No. ISO 15622)."},{"key":"ref_81","unstructured":"Caesar, H., Kabzan, J., Tan, K.S., Fong, W.K., Wolff, E., Lang, A., Fletcher, L., Beijbom, O., and Omari, S. (2021). nuPlan: A Closed-Loop ML-Based Planning Benchmark for Autonomous Vehicles. arXiv."},{"key":"ref_82","unstructured":"Coulter, R.C. (1992). Implementation of the Pure Pursuit Path Tracking Algorithm, Robotics Institute, Carnegie Mellon University. Technical Report CMU-RI-TR-92-01."},{"key":"ref_83","doi-asserted-by":"crossref","unstructured":"Hoffmann, G.M., Tomlin, C.J., Montemerlo, M., and Thrun, S. (2007, January 9\u201313). Autonomous Automobile Trajectory Tracking for Off-Road Driving: Controller Design, Experimental Validation and Racing. Proceedings of the American Control Conference (ACC), New York, NY, USA.","DOI":"10.1109\/ACC.2007.4282788"},{"key":"ref_84","doi-asserted-by":"crossref","first-page":"23","DOI":"10.1109\/100.580977","article-title":"The Dynamic Window Approach to Collision Avoidance","volume":"4","author":"Fox","year":"1997","journal-title":"IEEE Robot. Autom. Mag."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/26\/18\/5973\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2026,9,24]],"date-time":"2026-09-24T04:14:43Z","timestamp":1790223283000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/26\/18\/5973"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2026,9,21]]},"references-count":84,"journal-issue":{"issue":"18","published-online":{"date-parts":[[2026,9]]}},"alternative-id":["s26185973"],"URL":"https:\/\/doi.org\/10.3390\/s26185973","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2026,9,21]]}}}