{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,7,30]],"date-time":"2026-07-30T13:01:15Z","timestamp":1785416475843,"version":"3.56.0"},"reference-count":28,"publisher":"MDPI AG","issue":"6","license":[{"start":{"date-parts":[[2026,5,29]],"date-time":"2026-05-29T00:00:00Z","timestamp":1780012800000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/501100001863","name":"New Energy and Industrial Technology Development Organization","doi-asserted-by":"publisher","award":["JPNP18002"],"award-info":[{"award-number":["JPNP18002"]}],"id":[{"id":"10.13039\/501100001863","id-type":"DOI","asserted-by":"publisher"}]},{"award":["JPNP18002"],"award-info":[{"award-number":["JPNP18002"]}],"id":[{"id":"https:\/\/ror.org\/0055k7a87","id-type":"ROR","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Robotics"],"abstract":"<jats:p>Conventional robot motion teaching methods are time-consuming and place a significant burden on operators, especially when trajectory modification is required after contact with the environment. This paper proposes a six-dimensional automatic path correction method that considers both the position and orientation of the end-effector. The operator specifies only the start, goal, and via points of the motion path. Contact wrench information obtained during execution is incorporated into a cost function, and the control points of a spline-based trajectory are iteratively optimized. The method does not rely on an explicit environment model and autonomously updates the trajectory based on contact information. Simulation experiments were conducted on three industrial tasks: part box unloading, yarn cone removal, and part extraction. In all tasks, the proposed method successfully generated collision-free trajectories within a small number of correction iterations and with practical computation time. These results indicate that the proposed approach enables stable and efficient trajectory correction while reducing the teaching burden in industrial support tasks.<\/jats:p>","DOI":"10.3390\/robotics15060108","type":"journal-article","created":{"date-parts":[[2026,5,29]],"date-time":"2026-05-29T10:06:56Z","timestamp":1780049216000},"page":"108","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":0,"title":["Pose-Constrained Path Optimization for Manipulators with Contact Feedback from Sparse Waypoints"],"prefix":"10.3390","volume":"15","author":[{"given":"Yuta","family":"Kasahara","sequence":"first","affiliation":[{"name":"Department of Mechanical Engineering, Faculty of Engineering, Shizuoka University, 3-5-1 Johoku, Chuo-ku, Hamamatsu 432-8561, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-0189-0060","authenticated-orcid":false,"given":"Yuichi","family":"Kobayashi","sequence":"additional","affiliation":[{"name":"Department of Mechanical Engineering, Faculty of Engineering, Shizuoka University, 3-5-1 Johoku, Chuo-ku, Hamamatsu 432-8561, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-2402-5179","authenticated-orcid":false,"given":"Tomohiro","family":"Hayakawa","sequence":"additional","affiliation":[{"name":"Department of Mechanical Engineering, Faculty of Engineering, Shizuoka University, 3-5-1 Johoku, Chuo-ku, Hamamatsu 432-8561, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-0561-1957","authenticated-orcid":false,"given":"Francisco Jes\u00fas Arjonilla","family":"Garc\u00eda","sequence":"additional","affiliation":[{"name":"Department of Mechanical Engineering, Faculty of Engineering, Shizuoka University, 3-5-1 Johoku, Chuo-ku, Hamamatsu 432-8561, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Kazuki","family":"Yamamoto","sequence":"additional","affiliation":[{"name":"Department of Mechanical Engineering, Faculty of Engineering, Shizuoka University, 3-5-1 Johoku, Chuo-ku, Hamamatsu 432-8561, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Keiji","family":"Takeshita","sequence":"additional","affiliation":[{"name":"Shibaura Machine Co., Ltd., 4-29-1 Hibarigaoka, Zama 252-0003, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Yuya","family":"Wada","sequence":"additional","affiliation":[{"name":"Shibaura Machine Co., Ltd., 4-29-1 Hibarigaoka, Zama 252-0003, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Yoichiro","family":"Nakamura","sequence":"additional","affiliation":[{"name":"Shibaura Machine Co., Ltd., 4-29-1 Hibarigaoka, Zama 252-0003, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2026,5,29]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"87","DOI":"10.1016\/j.rcim.2011.08.004","article-title":"Recent Progress on Programming Methods for Industrial Robots","volume":"28","author":"Pan","year":"2012","journal-title":"Robot. Comput.-Integr. Manuf."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"162467","DOI":"10.1109\/ACCESS.2025.3609980","article-title":"Vision-Language-Action Models for Robotics: A Review Towards Real-World Applications","volume":"13","author":"Kawaharazuka","year":"2025","journal-title":"IEEE Access"},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Brohan, A., Brown, N., Carbajal, J., Chebotar, Y., Dabis, J., Finn, C., Gopalakrishnan, K., Hausman, K., Herzog, A., and Hsu, J. (2023, January 10\u201314). RT-1: Robotics Transformer for Real-World Control at Scale. Proceedings of the Robotics: Science and Systems XIX. Robotics: Science and Systems Foundation, Daegu, Republic of Korea.","DOI":"10.15607\/RSS.2023.XIX.025"},{"key":"ref_4","first-page":"2165","article-title":"RT-2: Vision-Language-Action Models Transfer Web Knowledge to Robotic Control","volume":"Volume 229","author":"Tan","year":"2023","journal-title":"Proceedings of the 7th Conference on Robot Learning"},{"key":"ref_5","unstructured":"Ichter, B., Brohan, A., Chebotar, Y., Finn, C., Hausman, K., Herzog, A., Ho, D., Ibarz, J., Irpan, A., and Jang, E. (2023). Do As I Can, Not As I Say: Grounding Language in Robotic Affordances. Proceedings of the 6th Conference on Robot Learning, PMLR."},{"key":"ref_6","unstructured":"Driess, D., Xia, F., Sajjadi, M.S.M., Lynch, C., Chowdhery, A., Ichter, B., Wahid, A., Tompson, J., Vuong, Q., and Yu, T. (2023). PaLM-E: An Embodied Multimodal Language Model. Proceedings of the 40th International Conference on Machine Learning, PMLR."},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Wu, Z., Zhou, Y., Xu, X., Wang, Z., and Yan, H. (2025, January 11\u201315). MoManipVLA: Transferring Vision-language-action Models for General Mobile Manipulation. Proceedings of the IEEE\/CVF Conference on Computer Vision and Pattern Recognition (CVPR), Nashville, TN, USA.","DOI":"10.1109\/CVPR52734.2025.00167"},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"1238","DOI":"10.1177\/0278364913495721","article-title":"Reinforcement Learning in Robotics: A Survey","volume":"32","author":"Kober","year":"2013","journal-title":"Int. J. Robot. Res."},{"key":"ref_9","doi-asserted-by":"crossref","unstructured":"Chen, L., Jiang, Z., Cheng, L., Knoll, A.C., and Zhou, M. (2022). Deep Reinforcement Learning Based Trajectory Planning under Uncertain Constraints. Front. Neurorobot., 16.","DOI":"10.3389\/fnbot.2022.883562"},{"key":"ref_10","first-page":"1","article-title":"End-to-End Training of Deep Visuomotor Policies","volume":"17","author":"Levine","year":"2016","journal-title":"J. Mach. Learn. Res."},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Zhao, W., Queralta, J.P., and Westerlund, T. (2020, January 1\u20134). Sim-to-Real Transfer in Deep Reinforcement Learning for Robotics: A Survey. Proceedings of the 2020 IEEE Symposium Series on Computational Intelligence (SSCI), Canberra, Australia.","DOI":"10.1109\/SSCI47803.2020.9308468"},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"4733","DOI":"10.1109\/TRO.2024.3468770","article-title":"Using Implicit Behavior Cloning and Dynamic Movement Primitive to Facilitate Reinforcement Learning for Robot Motion Planning","volume":"40","author":"Zhang","year":"2024","journal-title":"IEEE Trans. Robot."},{"key":"ref_13","unstructured":"LaValle, S.M. (1998). Rapidly-Exploring Random Trees: A New Tool for Path Planning, Iowa State University. Technical Report TR 98-11."},{"key":"ref_14","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_15","doi-asserted-by":"crossref","first-page":"90","DOI":"10.1177\/027836498600500106","article-title":"Real-Time Obstacle Avoidance for Manipulators and Mobile Robots","volume":"5","author":"Khatib","year":"1986","journal-title":"Int. J. Robot. Res."},{"key":"ref_16","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 2009 IEEE International Conference on Robotics and Automation, Kobe, Japan.","DOI":"10.1109\/ROBOT.2009.5152817"},{"key":"ref_17","doi-asserted-by":"crossref","unstructured":"Kalakrishnan, M., Chitta, S., Theodorou, E., Pastor, P., and Schaal, S. (2011, January 9\u201313). STOMP: Stochastic Trajectory Optimization for Motion Planning. Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980280"},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Schulman, J., Ho, J., Lee, A., Awwal, I., Bradlow, H., and Abbeel, P. (2013, January 24\u201328). Finding Locally Optimal, Collision-Free Trajectories with Sequential Convex Optimization. Proceedings of the Robotics: Science and Systems IX. Robotics: Science and Systems Foundation, Berlin, Germany.","DOI":"10.15607\/RSS.2013.IX.031"},{"key":"ref_19","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_20","doi-asserted-by":"crossref","first-page":"427","DOI":"10.1017\/S0263574709005748","article-title":"Time-optimal task scheduling for articulated manipulators in environments cluttered with obstacles","volume":"28","author":"Xidias","year":"2010","journal-title":"Robotica"},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Laha, R., Sun, R., Wu, W., Mahalingam, D., Chakraborty, N., Figueredo, L.F., and Haddadin, S. (2022, January 23\u201327). Coordinate Invariant User-Guided Constrained Path Planning with Reactive Rapidly Expanding Plane-Oriented Escaping Trees. Proceedings of the 2022 International Conference on Robotics and Automation (ICRA), Philadelphia, PA, USA.","DOI":"10.1109\/ICRA46639.2022.9812014"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"126","DOI":"10.1109\/TRO.2017.2765335","article-title":"Trajectory Deformations From Physical Human\u2013Robot Interaction","volume":"34","author":"Losey","year":"2018","journal-title":"IEEE Trans. Robot."},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Liu, Q., Liu, Y., Li, Y., Zhu, C., Meng, W., Ai, Q., and Xie, S.Q. (2021). Path Planning and Impedance Control of a Soft Modular Exoskeleton for Coordinated Upper Limb Rehabilitation. Front. Neurorobot., 15.","DOI":"10.3389\/fnbot.2021.745531"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"308","DOI":"10.1093\/comjnl\/7.4.308","article-title":"A Simplex Method for Function Minimization","volume":"7","author":"Nelder","year":"1965","journal-title":"Comput. J."},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Todorov, E., Erez, T., and Tassa, Y. (2012, January 7\u201312). MuJoCo: A Physics Engine for Model-Based Control. Proceedings of the 2012 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Vilamoura-Algarve, Portugal.","DOI":"10.1109\/IROS.2012.6386109"},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"919","DOI":"10.1080\/01691864.2021.1928545","article-title":"Numerical Method for Inverse Kinematics Using an Extended Angle-Axis Vector to Avoid Deadlock Caused by Joint Limits","volume":"35","author":"Sekiguchi","year":"2021","journal-title":"Adv. Robot."},{"key":"ref_27","unstructured":"Nguyen, N.T., Kowalczyk, R., and Filipe, J. (2016). Manifold Learning Approach Toward Constructing State Representation for Robot Motion Generation. Transactions on Computational Collective Intelligence XXIV, Springer."},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Somei, T., Kobayashi, Y., Shimizu, A., and Kaneko, T. (2013, January 15\u201317). Clustering of image features based on contact and occlusion among robot body and objects. Proceedings of the 2013 IEEE Workshop on Robot Vision (WORV), Clearwater Beach, FL, USA.","DOI":"10.1109\/WORV.2013.6521939"}],"container-title":["Robotics"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2218-6581\/15\/6\/108\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2026,5,29]],"date-time":"2026-05-29T10:28:19Z","timestamp":1780050499000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2218-6581\/15\/6\/108"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2026,5,29]]},"references-count":28,"journal-issue":{"issue":"6","published-online":{"date-parts":[[2026,6]]}},"alternative-id":["robotics15060108"],"URL":"https:\/\/doi.org\/10.3390\/robotics15060108","relation":{},"ISSN":["2218-6581"],"issn-type":[{"value":"2218-6581","type":"electronic"}],"subject":[],"published":{"date-parts":[[2026,5,29]]}}}