Constrained Inverse Kinematics of Minimally Invasive Surgical Robots: History
Please note this is an old version of this entry, which may differ significantly from the current revision.
Contributor:

Minimally invasive surgery has undergone significant advancements, 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’s 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. 

  • surgical robot
  • inverse kinematics
  • constrained motion planning
  • minimally invasive surgery

1. Introduction

Minimally invasive surgery (MIS) is a standard surgical procedure that reduces trauma and accelerates recovery by using long and thin surgical instruments through small incisions to access the anatomy of the patients. However, loss of direct access to the surgical workspace and the limited dexterity of conventional surgical tools impose several challenges on the surgeon, including a lack of depth perception and haptic feedback [1], which increases cognitive workload. To overcome these limitations, there has been increasing interest in the development of robotic systems for robot-assisted minimally invasive surgery (RMIS), as they enhance the surgeon’s capabilities with 3D vision, dexterous surgical tools, and intuitive human–robot interfaces. Numerous robotic systems have been developed and studied in the literature. The most prominent example is the da Vinci surgical system [2], which has been widely adopted in numerous surgical rooms around the world and has performed diverse surgical procedures in different anatomical regions, such as laparoscopic, gynecological and general surgery [3]. The da Vinci surgical system employs multiple robotic arms, each equipped with a surgical instrument that accesses internal organs through trocars placed over the patient’s body. However, the da Vinci surgical system has a bulky setup, entails a high cost, and the dimensions of the robotic surgical tool make it unsuitable for all types of surgery. To address these limitations, novel robotic surgical systems have been proposed for specific surgical scenarios, such as eye surgery [4], transnasal surgery [5], or pediatric laparoscopic surgery [6].
A key constraint in RMIS is the requirement for a remote center of motion (RCM), which is a constraint located at the insertion point, typically a trocar, that must always be respected. The surgical tool must pivot over the RCM, limiting its mobility to four degrees of freedom (DOFs): translational motion along the tool axis, pitch and yaw rotations, and rotational motion along the tool axis. Various strategies have been proposed to ensure the RCM constraint and can be coarsely classified as mechanical and programmable RCMs [7]. RCM mechanisms typically use structures based on parallelograms, which facilitate motion control and prevent potential hazards by ensuring the constraint of the RCM at the mechanical level [8,9]. However, mechanical RCMs have a significant limitation in their lack of adaptability, as the location of the RCM is fixed and must be aligned with the trocar placed on the patient. As a result, the placement of the robotic system, as well as the layout of the surgical room, must be adapted to accommodate the mechanical structure. Moreover, the RCM mechanism occupies a considerable amount of space above the insertion point, limiting robotic arms’ range of motion and obstructing the assistant staff’s access. The da Vinci surgical system [10] is an example of a passive RCM. On the contrary, programmable RCMs offer flexibility with a software-based RCM that can be dynamically adjusted without the need for additional mechanical structures, which also reduces costs. It utilizes the redundancy found in typical robotic manipulators to keep the constraint through synchronized control of the manipulator’s joints. The DLR MIRO [11] is an example of a surgical robotic system that follows a programmable RCM strategy. However, this approach transforms the RCM problem into a control problem that requires real-time motion planning to solve.

2. Constrained Inverse Kinematics

Inverse kinematics is a fundamental problem in robotics, which involves determining the joint angles necessary to achieve a desired position and orientation of the end effector. For non-redundant manipulators, analytical approaches provide explicit solutions for the unconstrained inverse kinematics problem. However, when the robot has redundant degrees of freedom, the inverse kinematics problem becomes more complex, as there can be multiple kinematic solutions. Additionally, the problem can become more challenging when there are additional tasks and kinematic constraints that must be satisfied, such as obstacle avoidance or joint limits. In such cases, iterative numerical methods or optimization techniques are often used to find a suitable solution.
Constrained inverse kinematics is a critical building block for developing control strategies for robotic systems that must accomplish multiple tasks simultaneously. It has been extensively studied for various types of constraints, such as joint limits avoidance [12], obstacle avoidance [13], robot posture [14], and maximization of manipulability [15]. Kinematic redundancy, which occurs when the manipulator’s degrees of freedom are greater than those required to execute a task, is often utilized to satisfy these additional constraints [16].
Analytical approaches are commonly used to solve the constrained inverse kinematics problem [17,18]. Although they can provide closed-form solutions suitable for real-time robot control, the set of constraints that analytical IK solvers can handle is limited. Additionally, analytical solvers must be designed in advance and can be susceptible to changes in robot configuration.
Numerical solvers, on the other hand, are more generic and use iterative methods based on the local Jacobian inverse until convergence to an optimal solution. Numerical IK solvers are known to be slower than analytical methods, and active research has been carried out to speed up the solving time by looking for alternatives to Jacobian inverse computation [19] or combining it with other optimization-based methods [20]. Generic constraints can be included in an optimization-based numerical approach, in which the IK problem is formulated as a general nonconvex nonlinear optimization problem and solved by iterative gradient-based nonlinear solvers [21]. This approach can handle a wide range of constraints, including nonlinear and nonconvex ones, and is suitable for a variety of robotic applications. However, it can be computationally expensive and may require careful tuning of the solver parameters to achieve the desired performance.

3. Task Prioritization

When a hierarchy exists between constraint tasks in inverse kinematics, a prioritization scheme must be followed. Each task is assigned a priority level, and high-priority tasks should not be affected by lower-priority tasks [22]. There are two main categories of hierarchical IK schemes: strict and non-strict control methods.
Strict methods assume that each task is assigned a different priority, enforcing the hierarchy by projecting consecutively joint velocities from lower-priority tasks to the null space of higher-priority tasks. Siciliano and Slotine [23] proposed a hierarchical framework to handle an arbitrary number of tasks by considering the null space projector of one task in the next task solution in priority order. Chiaverini [24] proposed a different approach for two tasks that guarantees robustness against algorithmic singularity, which is later extended to multiple tasks in [25]. Hierarchical quadratic programming (HQP) has also been explored for strict hierarchical IK, solving a quadratic programming problem hierarchically under equality and inequality constraints. HQP has been used in humanoid robots [26], robot teleoperation [27], and human–robot collaboration [28].
Non-strict methods offer a simplified approach to task prioritization by assigning weights to each task according to its relative importance. This simplification reduces computational time and allows for more flexible control over the optimization problem. However, in cases where multiple tasks have the same priority level, non-strict methods can result in ambiguity and compromise the desired priority scheme. Additionally, it is challenging to completely isolate one task from the influence of another, even when assigning vastly different weights. A critical drawback of non-strict methods is the need for fine-tuning the weight assignment for each task, which can be time consuming and require expert knowledge.

4. Constrained Inverse Kinematics in RMIS

In RMIS, the preservation of the remote center of motion (RCM) is an essential constraint that must be addressed. Typically, programmable RCM constraints are formulated as high-priority tasks within a strict hierarchical control scheme. For instance, Azimian et al. [29] proposed a method that utilizes a projection of a secondary tool pose control task in the null space of the RCM task. The RCM constraint task is described as a kinematic restriction based on the plane tangent to the patient’s skin. They experimentally validated their approach in an endoscope positioning task. However, one of the limitations of their method is the assumption of constant tool insertion depth, which may not hold throughout the surgical procedure. To overcome this limitation, Aghakhani et al. [30] proposed a variation of the previous method, which considers the tool insertion velocity as an additional control variable. They utilize an augmented Jacobian approach in which the tool pose control task and the RCM constraint task Jacobians are stacked. The pseudoinverse of the augmented Jacobian provides a solution that satisfies both tasks. However, their method does not ensure the orthogonality of both task Jacobians, which can lead to algorithmic singularities in the augmented task Jacobian [31]. Another strict hierarchical approach was proposed by Sandoval et al. [32] for a torque-controlled manipulator. In their approach, they prioritize the task of minimizing the distance between the trocar point and the surgical tool, while a secondary task is defined as the control of the tool pose. Following this approach, they were able to achieve an accurate position of the tool tip while ensuring the preservation of the RCM.
While some approaches for RCM implementations consider independent tasks in a hierarchical scheme, others aim to unify the task. For example, Osa et al. [33] introduced a zero-velocity constraint in the normal plane of the tool axis to avoid lateral movement around the RCM. Marinho et al. [34] proposed generating a trajectory by projecting the desired endoscope position from the perspective of the RCM, then computing the corresponding joint configurations for the external joints. However, these methods have limitations, including their dependence on the number of links within the patient. For example, refs. [33,34] only consider one link after the trocar point, and joint limits are not directly taken into account in the RCM formulation.
Optimization-based RCM formulations can explicitly incorporate equality and inequality constraints, making them suitable for including joint limits in the problem. In [35], Kapoor et al. proposed a weighted multi-objective constrained optimization framework that uses a sequential quadratic programming approach to solve the nonlinear constrained problem. Yang et al. [36] employed a differential evolution algorithm to solve an endoscope visual servoing optimization problem subject to an RCM constraint.

This entry is adapted from the peer-reviewed paper 10.3390/s23063328

This entry is offline, you can click here to edit this entry!