{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,7,6]],"date-time":"2026-07-06T12:11:50Z","timestamp":1783339910168,"version":"3.54.6"},"reference-count":45,"publisher":"MDPI AG","issue":"6","license":[{"start":{"date-parts":[[2023,3,22]],"date-time":"2023-03-22T00:00:00Z","timestamp":1679443200000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/501100002241","name":"Japan Science and Technology Agency","doi-asserted-by":"publisher","award":["JPMJCR20D5"],"award-info":[{"award-number":["JPMJCR20D5"]}],"id":[{"id":"10.13039\/501100002241","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100002241","name":"Japan Science and Technology Agency","doi-asserted-by":"publisher","award":["22K14221"],"award-info":[{"award-number":["22K14221"]}],"id":[{"id":"10.13039\/501100002241","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100001691","name":"Japan Society for the Promotion of Science","doi-asserted-by":"publisher","award":["JPMJCR20D5"],"award-info":[{"award-number":["JPMJCR20D5"]}],"id":[{"id":"10.13039\/501100001691","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100001691","name":"Japan Society for the Promotion of Science","doi-asserted-by":"publisher","award":["22K14221"],"award-info":[{"award-number":["22K14221"]}],"id":[{"id":"10.13039\/501100001691","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>Minimally invasive surgery has undergone significant advancements in recent years, transforming various surgical procedures by minimizing patient trauma, postoperative pain, and recovery time. However, the use of robotic systems in minimally invasive surgery introduces significant challenges related to the control of the robot\u2019s motion and the accuracy of its movements. In particular, the inverse kinematics (IK) problem is critical for robot-assisted minimally invasive surgery (RMIS), where satisfying the remote center of motion (RCM) constraint is essential to prevent tissue damage at the incision point. Several IK strategies have been proposed for RMIS, including classical inverse Jacobian IK and optimization-based approaches. However, these methods have limitations and perform differently depending on the kinematic configuration. To address these challenges, we propose a novel concurrent IK framework that combines the strengths of both approaches and explicitly incorporates RCM constraints and joint limits into the optimization process. In this paper, we present the design and implementation of concurrent inverse kinematics solvers, as well as experimental validation in both simulation and real-world scenarios. Concurrent IK solvers outperform single-method solvers, achieving a 100% solve rate and reducing the IK solving time by up to 85% for an endoscope positioning task and 37% for a tool pose control task. In particular, the combination of an iterative inverse Jacobian method with a hierarchical quadratic programming method showed the highest average solve rate and lowest computation time in real-world experiments. Our results demonstrate that concurrent IK solving provides a novel and effective solution to the constrained IK problem in RMIS applications.<\/jats:p>","DOI":"10.3390\/s23063328","type":"journal-article","created":{"date-parts":[[2023,3,22]],"date-time":"2023-03-22T06:35:28Z","timestamp":1679466928000},"page":"3328","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":30,"title":["A Concurrent Framework for Constrained Inverse Kinematics of Minimally Invasive Surgical Robots"],"prefix":"10.3390","volume":"23","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-8833-2215","authenticated-orcid":false,"given":"Jacinto","family":"Colan","sequence":"first","affiliation":[{"name":"Department of Micro-Nano Mechanical Science and Engineering, Nagoya University, Furo-cho, Chikusa-ku, Nagoya 464-8603, Aichi, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-2076-6842","authenticated-orcid":false,"given":"Ana","family":"Davila","sequence":"additional","affiliation":[{"name":"Institutes of Innovation for Future Society, Nagoya University, Furo-cho, Chikusa-ku, Nagoya 464-8601, Aichi, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-7475-787X","authenticated-orcid":false,"given":"Khusniddin","family":"Fozilov","sequence":"additional","affiliation":[{"name":"Department of Micro-Nano Mechanical Science and Engineering, Nagoya University, Furo-cho, Chikusa-ku, Nagoya 464-8603, Aichi, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0001-9917-098X","authenticated-orcid":false,"given":"Yasuhisa","family":"Hasegawa","sequence":"additional","affiliation":[{"name":"Department of Micro-Nano Mechanical Science and Engineering, Nagoya University, Furo-cho, Chikusa-ku, Nagoya 464-8603, Aichi, Japan"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2023,3,22]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"334","DOI":"10.3390\/surgeries3040036","article-title":"A Review on Tactile Displays for Conventional Laparoscopic Surgery","volume":"3","author":"Colan","year":"2022","journal-title":"Surgeries"},{"key":"ref_2","unstructured":"Guthart, G.S., and Salisbury, J.K. (2000, January 24\u201328). The Intuitive telesurgery system: Overview and application. Proceedings of the 2000 IEEE International Conference on Robots and Automation (ICRA), San Francisco, CA, USA."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"56","DOI":"10.1109\/MRA.2021.3101646","article-title":"Accelerating Surgical Robotics Research: A Review of 10 Years with the da Vinci Research Kit","volume":"28","author":"Mariani","year":"2021","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"156","DOI":"10.1109\/TMRB.2022.3147033","article-title":"Autonomous Coordinated Control of the Light Guide for Positioning in Vitreoretinal Surgery","volume":"4","author":"Koyama","year":"2022","journal-title":"IEEE Trans. Med. Robot. Bionics"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Colan, J., Nakanishi, J., Aoyama, T., and Hasegawa, Y. (2020). A Cooperative Human-Robot Interface for Constrained Manipulation in Robot-Assisted Endonasal Surgery. Appl. Sci., 10.","DOI":"10.3390\/app10144809"},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"253","DOI":"10.1109\/TMRB.2021.3049878","article-title":"SmartArm: Suturing Feasibility of a Surgical Robotic System on a Neonatal Chest Model","volume":"3","author":"Marinho","year":"2021","journal-title":"IEEE Trans. Med Robot. Bionics"},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"382","DOI":"10.1007\/s11684-020-0781-x","article-title":"Review of surgical robotic systems for keyhole and endoscopic procedures: State of the art and perspectives","volume":"14","author":"Chen","year":"2020","journal-title":"Front. Med."},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"104013","DOI":"10.1016\/j.mechmachtheory.2020.104013","article-title":"Kinematic design of a non-parasitic 2R1T parallel mechanism with remote center of motion to be used in minimally invasive surgery applications","volume":"153","author":"Kiper","year":"2020","journal-title":"Mech. Mach. Theory"},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"127","DOI":"10.1002\/rcs.453","article-title":"Kinematic design considerations for minimally invasive surgical robots: An overview","volume":"8","author":"Kuo","year":"2012","journal-title":"Int. J. Med Robot. Comput. Assist. Surg."},{"key":"ref_10","doi-asserted-by":"crossref","first-page":"396","DOI":"10.1002\/rcs.1468","article-title":"Technical review of the da Vinci surgical telemanipulator","volume":"9","author":"Freschi","year":"2013","journal-title":"Int. J. Med Robot. Comput. Assist. Surg."},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"183","DOI":"10.1007\/s11548-009-0372-4","article-title":"DLR MiroSurge: A versatile system for research in endoscopic telesurgery","volume":"5","author":"Hagn","year":"2010","journal-title":"Int. J. Comput. Assist. Radiol. Surg."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"16","DOI":"10.3389\/frobt.2016.00016","article-title":"Set-Based Tasks within the Singularity-Robust Multiple Task-Priority Inverse Kinematics Framework: General Formulation, Stability Analysis, and Experimental Results","volume":"3","author":"Moe","year":"2016","journal-title":"Front. Robot. AI"},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"257","DOI":"10.1109\/TRO.2020.3018642","article-title":"On Null Space-Based Inverse Kinematics Techniques for Fleet Management: Toward Time-Varying Task Activation","volume":"37","author":"Mannucci","year":"2021","journal-title":"IEEE Trans. Robot."},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"670","DOI":"10.1109\/TRO.2009.2020345","article-title":"A Unified Approach to Integrate Unilateral Constraints in the Stack of Tasks","volume":"25","author":"Mansard","year":"2009","journal-title":"IEEE Trans. Robot."},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"3","DOI":"10.1007\/s10846-020-01171-7","article-title":"On maximizing manipulability index while solving a kinematics task","volume":"100","author":"Dufour","year":"2020","journal-title":"J. Intell. Robot. Syst."},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"410","DOI":"10.1177\/027836499101000409","article-title":"Closed-Loop Inverse Kinematics Schemes for Constrained Redundant Manipulators with Task Space Augmentation and Task Priority Strategy","volume":"10","author":"Chiacchio","year":"1991","journal-title":"Int. J. Robot. Res."},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"1435","DOI":"10.1177\/0278364910396389","article-title":"Task Space Regions: A framework for pose-constrained manipulation planning","volume":"30","author":"Berenson","year":"2011","journal-title":"Int. J. Robot. Res."},{"key":"ref_18","unstructured":"Diankov, R. (2010). Automated Construction of Robotic Manipulation Programs. [Ph.D. Thesis, Carnegie Mellon University]."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Escande, A., Mansard, N., and Wieber, P.B. (2010, January 3\u20137). Fast resolution of hierarchized inverse kinematics with inequality constraints. Proceedings of the 2010 IEEE International Conference on Robotics and Automation, Anchorage, AK, USA.","DOI":"10.1109\/ROBOT.2010.5509953"},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Beeson, P., and Ames, B. (2015, January 3\u20135). TRAC-IK: An open-source library for improved solving of generic inverse kinematics. Proceedings of the 2015 IEEE-RAS 15th International Conference on Humanoid Robots, Seoul, Republic of Korea.","DOI":"10.1109\/HUMANOIDS.2015.7363472"},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"1420","DOI":"10.1177\/0278364919846512","article-title":"Global inverse kinematics via mixed-integer convex optimization","volume":"38","author":"Dai","year":"2019","journal-title":"Int. J. Robot. Res."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"3537","DOI":"10.1109\/LRA.2019.2927945","article-title":"Prioritized Inverse Kinematics: Generalization","volume":"4","author":"An","year":"2019","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Siciliano, B., and Slotine, J.J. (1991, January 19\u201322). A general framework for managing multiple tasks in highly redundant robotic systems. Proceedings of the Fifth International Conference on Advanced Robotics \u2019Robots in Unstructured Environments, Pisa, Italy.","DOI":"10.1109\/ICAR.1991.240390"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"398","DOI":"10.1109\/70.585902","article-title":"Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators","volume":"13","author":"Chiaverini","year":"1997","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"60","DOI":"10.1109\/TRO.2006.889487","article-title":"Task Sequencing for High-Level Sensor-Based Control","volume":"23","author":"Mansard","year":"2007","journal-title":"IEEE Trans. Robot."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"1006","DOI":"10.1177\/0278364914521306","article-title":"Hierarchical quadratic programming: Fast online humanoid-robot motion generation","volume":"33","author":"Escande","year":"2014","journal-title":"Int. J. Robot. Res."},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Gholami, S., Tassi, F., De Momi, E., and Ajoudani, A. (October, January 27). A Reconfigurable Interface for Ergonomic and Dynamic Tele-Locomanipulation. Proceedings of the 2021 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Prague, Czech Republic.","DOI":"10.1109\/IROS51168.2021.9636775"},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Tassi, F., De Momi, E., and Ajoudani, A. (June, January 30). Augmented Hierarchical Quadratic Programming for Adaptive Compliance Robot Control. Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi\u2019an, China.","DOI":"10.1109\/ICRA48506.2021.9561506"},{"key":"ref_29","doi-asserted-by":"crossref","unstructured":"Azimian, H., Patel, R.V., and Naish, M.D. (2010, January 26\u201329). On constrained manipulation in robotics-assisted minimally invasive surgery. Proceedings of the 2010 3rd IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics, Tokyo, Japan.","DOI":"10.1109\/BIOROB.2010.5627985"},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Aghakhani, N., Geravand, M., Shahriari, N., Vendittelli, M., and Oriolo, G. (2013, January 6\u201310). Task control with remote center of motion constraint for minimally invasive robotic surgery. Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany.","DOI":"10.1109\/ICRA.2013.6631412"},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Marinho, M.M., Harada, K., and Mitsuishi, M. (2017, January 11\u201314). Comparison of remote center-of-motion generation algorithms. Proceedings of the 2017 IEEE\/SICE International Symposium on System Integration (SII), Taipei, Taiwan.","DOI":"10.1109\/SII.2017.8279298"},{"key":"ref_32","doi-asserted-by":"crossref","unstructured":"Sandoval, J., Poisson, G., and Vieyres, P. (2017, January 24\u201328). A new kinematic formulation of the RCM constraint for redundant torque-controlled robots. Proceedings of the 2017 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Vancouver, BC, Canada.","DOI":"10.1109\/IROS.2017.8206326"},{"key":"ref_33","doi-asserted-by":"crossref","unstructured":"Osa, T., Staub, C., and Knoll, A. (2010, January 18\u201322). Framework of Automatic Robot Surgery System using Visual Servoing. Proceedings of the 2010 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Taipei, Taiwan.","DOI":"10.1109\/IROS.2010.5650301"},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"1650007","DOI":"10.1142\/S2424905X16500070","article-title":"Using General-Purpose Serial-Link Manipulators for Laparoscopic Surgery with Moving Remote Center of Motion","volume":"1","author":"Marinho","year":"2016","journal-title":"J. Med Robot. Res."},{"key":"ref_35","unstructured":"Kapoor, A., Li, M., and Taylor, R. (2006, January 15\u201319). Constrained control for surgical assistant robots. Proceedings of the 2006 IEEE International Conference on Robotics and Automation, ICRA 2006, Orlando, FL, USA."},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"7934","DOI":"10.1109\/LRA.2022.3186507","article-title":"Autonomous Laparoscope Control for Minimally Invasive Surgery With Intuition and RCM Constraints","volume":"7","author":"Yang","year":"2022","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_37","doi-asserted-by":"crossref","unstructured":"Colan, J., Nakanishi, J., Aoyama, T., and Hasegawa, Y. (2021). Optimization-Based Constrained Trajectory Generation for Robot-Assisted Stitching in Endonasal Surgery. Robotics, 10.","DOI":"10.3390\/robotics10010027"},{"key":"ref_38","unstructured":"Sol\u00e0, J., Deray, J., and Atchuthan, D. (2018). A micro Lie theory for state estimation in robotics. arXiv."},{"key":"ref_39","doi-asserted-by":"crossref","first-page":"785","DOI":"10.1109\/TRO.2011.2142450","article-title":"Kinematic Control of Redundant Manipulators: Generalizing the Task-Priority Framework to Inequality Task","volume":"27","author":"Kanoun","year":"2011","journal-title":"IEEE Trans. Robot."},{"key":"ref_40","doi-asserted-by":"crossref","unstructured":"Carpentier, J., Saurel, G., Buondonno, G., Mirabel, J., Lamiraux, F., Stasse, O., and Mansard, N. (2019, January 14\u201316). The Pinocchio C++ library: A fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives. Proceedings of the 2019 IEEE\/SICE International Symposium on System Integration (SII), Paris, France.","DOI":"10.1109\/SII.2019.8700380"},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1007\/s12532-018-0139-4","article-title":"CasADi: A software framework for nonlinear optimization and optimal control","volume":"11","author":"Andersson","year":"2019","journal-title":"Math. Program. Comput."},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"25","DOI":"10.1007\/s10107-004-0559-y","article-title":"On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming","volume":"106","author":"Biegler","year":"2006","journal-title":"Math. Program."},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"637","DOI":"10.1007\/s12532-020-00179-2","article-title":"OSQP: An operator splitting solver for quadratic programs","volume":"12","author":"Stellato","year":"2020","journal-title":"Math. Program. Comput."},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Rohmer, E., Singh, S.P.N., and Freese, M. (2013, January 3\u20137). V-REP: A versatile and scalable robot simulation framework. Proceedings of the 2013 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Tokyo, Japan.","DOI":"10.1109\/IROS.2013.6696520"},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"6092","DOI":"10.1109\/ACCESS.2023.3236821","article-title":"OpenRST: An Open Platform for Customizable 3D Printed Cable-Driven Robotic Surgical Tools","volume":"11","author":"Colan","year":"2023","journal-title":"IEEE Access"}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/23\/6\/3328\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,10]],"date-time":"2025-10-10T19:00:19Z","timestamp":1760122819000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/23\/6\/3328"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2023,3,22]]},"references-count":45,"journal-issue":{"issue":"6","published-online":{"date-parts":[[2023,3]]}},"alternative-id":["s23063328"],"URL":"https:\/\/doi.org\/10.3390\/s23063328","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2023,3,22]]}}}