key: cord-0025144-k8t8ct1w authors: Ficuciello, Fanny; Villani, Alberto; Lisini Baldi, Tommaso; Prattichizzo, Domenico title: A Human Gesture Mapping Method to Control a Multi‐Functional Hand for Robot‐Assisted Laparoscopic Surgery: The MUSHA Case date: 2021-12-10 journal: Front Robot AI DOI: 10.3389/frobt.2021.741807 sha: b1eabb450c1fb943a85a4a3c2a767f29b5678b53 doc_id: 25144 cord_uid: k8t8ct1w This work presents a novel technique to control multi-functional hand for robot-assisted laparoscopic surgery. We tested the technique using the MUSHA multi-functional hand, a robot-aided minimally invasive surgery tool with more degrees of freedom than the standard commercial end-effector of the da Vinci robot. Extra degrees of freedom require the development of a proper control strategy to guarantee high performance and avoid an increasing complexity of control consoles. However, developing reliable control algorithms while reducing the control side’s mechanical complexity is still an open challenge. In the proposed solution, we present a control strategy that projects the human hand motions into the robot actuation space. The human hand motions are tracked by a LeapMotion camera and mapped into the actuation space of the virtualized end-effector. The effectiveness of the proposed method was evaluated in a twofold manner. Firstly, we verified the Lyapunov stability of the algorithm, then an user study with 10 subjects assessed the intuitiveness and usability of the system. In minimally invasive surgery (MIS), surgical instruments are introduced into the patient's body through small incisions, this practice allows to reduce trauma. As scientific research has amply demonstrated, MIS offers several benefits such as reduced pain, limited post-operative course, and short patient recovery times (Perigli et al., 2008; Sood et al., 2017; Hanley et al., 2019; Chadi et al., 2020) . On the other hand, 1) the surgeon loses dexterity due to the limited range of movement of the instruments and their limited number of degrees of freedom (DoFs), 2) there is a reduction of tactile sensations with a consequent risk of tissue damage, and 3) the hand-eye coordination decrease. Nowadays, according to Tonutti et al. (2017) , such of these issues are addressed by the introduction of technology in surgical rooms. Indeed, robotics has proven to be a viable solution to mitigate the limitations associated with the MIS. Rapid advances in image systems and computer technologies have led to significant advances in robotics applied to medicine. Robot-assisted surgery is now a common practice for several surgical operations and will probably become the most exploited surgical procedure of the future (Song et al., 2009; Parisi et al., 2017; Kulaylat et al., 2018; Sheetz et al., 2020) . In this context, the da Vinci robot (Intuitive Surgical Inc.) demonstrated effective recovery of hand-eye coordination and motion dexterity. Research done in the last decade has been focused on overcoming existing deficiencies of robotic surgery systems, e.g., lack of haptic feedback (Okamura, 2009; Manganelli et al., 2010; Meli et al., 2014; Mohareri et al., 2014 ), enhancement of system integration (Handini et al., 2004; Leven et al., 2005; Takács et al., 2015) , and combination of augmented reality navigation functionalities (Sugimoto et al., 2010; Yamamoto et al., 2012; Tabrizi and Mahvash, 2015) . Other research and development activities aim to realize outstanding training systems, including the next generation of virtual reality simulators ( Van der Meijden et al., 2010; Fontanelli et al., 2018) . More than one thousand publications are available in literature discussing medical robots control approaches and surgeon side console (Beasley, 2012) . A bilateral control, with position-position architecture, is the standard approach to control short distance telerobotic systems for surgery, according to Niemeyer and Slotine (1991) . For instance, in setups equipped with the da Vinci robot the position of the surgeon's hand is mapped into the position of the surgery tool and the foot-pedal enables a temporary disconnection between the two sides to reconfigure the control manipulator into a more comfortable and ergonomic pose. For some applications, impedance control and switched-impedance control are used as a valid alternative (Cheng and Tavakoli, 2018) . For instance, a strategy exploiting force based model predictive control for beating heart surgery is presented by Bebek and Cavusoglu (2006) . These approaches are usually reinforced by identification techniques of robotic arms as described in Fontanelli et al. (2017) , and by techniques of shared autonomy as motion compensation, collision avoidance , active constrains, and shared task space (Bowyer et al., 2013) . An innovative surgery control console is presented in Sukhoon et al. (2009) , the developed robot controller fully replicate the reference movements. Similarly, in Kim et al. (2013) the authors propose a control device mechanically similar to the robot end effector, coupled with a system for regulating the joints stiffness in accordance with the exerted force. On this line, new consoles are designed to recover tactile perception integrating haptic technologies. For instance, (Yin et al., 2015) used magnetorheological fluids to return haptic sensations. Grounded commercial haptic devices as Omega (Force Dimension, CH) or Falcon (Novint Technologies Inc., United States) replace the control side in some experiments to project a more portable and sensorily complete experience of control as in the case reported in Tang et al. (2016) . In Madhani et al. (1998) a solution built with two PHANToM haptic devices is presented, whereas (Cavusoglu et al., 1999) shows a six DoFs laparoscopic telesurgery workstation composed of an Immersion System Impulse Engine 3000 and two additional motors. the authors in Hu et al. (2016) developed a tendon driven exoskeleton to control a surgical robot and provide force stimuli, a camera system tracks the positions of fingers of the surgeon, while bilateral Bowden cables return kinesthetic information. However, an open issue is the limited number of DoFs of robotic surgical end-effectors. In fact, the surgeon side manipulators of the da Vinci robot provides only eight DoFs to control the (Patient Side Manipulator) PSM position and the orientation and enclosure state of the common EndoWrist (Intuitive Surgical Inc., United States), bipolar and monopolar tools used to grasp, stamp or cut the organic tissues. Introducing extra degrees of freedom requires the development of suitable control (Gioioso et al., 2013; Meeker et al., 2018) , or the development of alternative control consoles to move them independently. For instance, the MUSHA hand (depicted in Figure 1 ) is a three-soft-finger robotic gripper for surgical application (Liu et al., 2020) . It is developed to be connected with the da Vinci robot, but it has more degrees of actuation (DoA) than DoFs of surgeon console interface. For this reason, the DoAs of the MUSHA hand are controlled synergistically, however, this reduces the potential of the instrument by limiting the number of configurations that can be reached by the fingers. The contribution of this paper is a human to MUSHA hand mapping algorithm to perform full teleoperation of surgical hand DoAs, without increasing the mechanical complexity of the surgeon console. For this purpose, we use a camera system to track the human hand motion. The algorithm can easily be adapted to any robotic tool, the resulted algorithm is corroborated by a theoretical analysis of stability and it is followed by a preliminary study about forces exerted by fingertips. The teleoperated MUSHA hand system is composed of surgical gripper and the da Vinci robot arm in patient side, while the surgeon side is comprehensive of a human hand tracker system. Communication between the surgeon and patient side is provided by Robot Operating System (ROS). The MUSHA hand is the main and innovative part of the teleoperation system, while the PSM of the da Vinci robot is Liu et al. (2019) , and as anticipated in Section 1, the tool is a three-fingered underactuated miniature hand, each finger is composed of 12 segments and connected with a one DoF wrist, the kinematic model is composed of 37 joints connected by 36 links. An optoelectronic force sensor is designed, calibrated and presented in Liu et al. (2020) , and located at the tip of each finger. In the range of the sensors, equal to 4 N, the maximal error on x-, y-, and z-direction is 0.28, 0.24, and 0.75 N, respectively. The MUSHA is actuated by the four motors of da Vinci PSM plus two additional motors. As a result, six joints are independent and directly connected to actuators by tendons, while the other ones are passive. For these reasons, it is possible to define a reduced kinematic model composed of actuated joints and equivalent links ( Figure 2 ). The kinematic structure and the actuation system are designed to be multifunctional allowing the MUSHA hand performing three main methods of grasp, depicted in Figure 3 : 1) power grasp (Po), 2) precision grasp (Pr) and 3) retractor (Rt). During the power grasp method, all fingertips and phalanges are involved to hold firmly tissue, in the precision grasp method only the fingertips are used to pinch tissue, and the retractor method allows the retraction of the tissues that come in contact with phalanges of index and middle fingertips. The relationship between joints and the tips position for a single robotic finger results as: x r,ρ cos q 1,ρ a 2 cos q 2,ρ + a 3 cos q 2,ρ + q 3,ρ y r,ρ sin q 1,ρ a 2 cos q 2,ρ + a 3 cos q 2,ρ + q 3,ρ z r,ρ a 2 sin q 2,ρ + a 3 sin q 2,ρ + q 3,ρ ∀ρ ∈ T, I, M { } where q i,ρ is the value of the i-th joint of the robotic hand r ρ-th finger and a i is the length of the i-th link. We refer with T, I, M the thumb, index, and middle finger, respectively. Thanks to the mechanical properties of the robotic tool tendon-driven transmission, q 3,ρ and q 2,ρ are decoupled and thus they can be independently controlled, it follows that the model can be rewritten as x r,ρ cos q 1,ρ a 2 cos q 2,ρ + a 3 cos q 3,ρ y r,ρ sin q 1,ρ a 2 cos q 2,ρ + a 3 cos q 3,ρ z r,ρ a 2 sin q 2,ρ + a 3 sin q 3,ρ ∀ρ ∈ T, I, M { } . ( The complete kinematic model of the MUSHA hand, p r K(·), is obtained exploiting (2) for each finger, thus p r K(q 1,T , q 2,T , q 3,T , q 1,I , q 2,I , q 3,I , q 1,M , q 2,M , q 3,M ). According to the sub-actuation constrains we define the wrist angle position, q W , and the index and medium proximal one, qPIP,: we can simplify the kinematic relationship, obtaining: where p r is a vector containing the fingertips position expressed in Cartesian coordinate. It is worth noticing that in the exploited model, the length of the links a 2 and a 3 depends on the joint values. Indeed, the coupling motion of the phalanx segments (generated by the tendons) causes links shrinkage. In accordance with the chord theorem (see Figure 4 ), the length of the links can be computed as Let q ij,ρ be the joint j in the phalanx i of the finger ρ, ∀i ∈ {2, 3} and ∀ρ ∈ {T, I, M}. Consequently, it is possible to write the length of the chord in kinematic model and the length of the link in the actuated model as follows: where L i , ρ is the length of the arc of the i-th phalanx of the finger ρ. Assuming that the action of the tendons is equal on all the segments, the angular displacements are equal to a fraction of the equivalent joint in the reduced model: As a consequence, ∀ρ ∈ {T, I, M} the single finger model becomes: x r,ρ cos q 1,ρ a 2,ρ cos q 2,ρ + a 3,ρ cos q 3,ρ (8) y r,ρ sin q 1,ρ a 2,ρ cos q 2,ρ + a 3,ρ cos q 3,ρ z r,ρ a 2,ρ sin q 2,ρ + a 3,ρ sin q 3,ρ a 2,ρ 6L 2,ρ 5q 2,ρ sin 5q 2,ρ 6 Therefore, the explicit full hand model (reported in the Supplementary Material) has 14 equations nine of which linearly independent, in six variables. Finally, we can express _ p r J w r _ q r , where J w r is the Jacobian matrix of the robotic fingers of MUSHA expressed in reference frame of the wrist. The differential model is fully reported in the Supplementary (see Supplementary Section S5.2). In this section, we report the simplified kinematic model of the hand, which will be instrumental in the design of the control technique. Even if a complete human hand model has about 30 DoF (Lee and Kunii, 1995) , for the sake of simplicity and without loss of generality we use a simplified kinematic hand structure. We modeled each finger as a planar kinematic chain, with three 1-D hinges. As in Lisini et al. (2017) , we assume that each finger has the metacarpal (MC) bone fixed with respect to the hand frame, and it is characterized by three DoFs. In a more complete model of the human hand, the thumb has at least five DoFs: two in the trapeziometacarpal (TM) joint, two in the metacarpophalangeal (MCP) joint, and one in the interphalangeal (IP) joint. However, the thumb abduction/adduction motion range of the MCP joint usually can be neglected so the thumb can be modeled with two DoFs. Index, middle, ring, and pinky fingers have one DoFs in the MCP revolute joint for flexion/extension, one in the proximal IP (PIP), and one in the distal IP (DIP). Figure 5 shows the model of the hand used in this work. Therefore, the exploited hand model has 20 DoFs. i.e., 14 DoFs describing the fingers and six DoFs (position and orientation) for the palm. Finally, we introduce the relationship between fingertips and joints velocities, which can be described by the differential model: where the matrix J h ∈ R 15×20 is the hand Jacobian, that maps the joint velocities ( _ q h ∈ R 20 ) to the Cartesian fingertip velocities ( _ p h ∈ R 15 ). Starting from the definition of the human hand and the MUSHA hand models, the developed method to control the MUSHA hand and the da Vinci robot arm are explained. A standard point-topoint mapping technique is used to control the PSM, while an innovative approach based on the theory of mapping in object domain to teleoperate the MUSHA fingers is designed and implemented. We assume that the human and the robotic hands are constantly in touch with a similar virtual object, all possible contact points are called active points. The positions of MUSHA active points p r are defined as the positions of fingertips, while the human active points (p h ⊂p h ) are given by the positions of palm (P), thumb, index, and middle fingertips: We indicate with p h,ρ a vector of Cartesian positions of the ρ-th finger of the human hand h expressed in the world reference frame: Depending on the grasping method, we define the vector of interaction points, c h , equal to a subset of active points of the human hand involved in the desired grasp, and evaluated as: and It is worth noticing that Ω is a selection vector that is evaluated on-line to allow switch control reference without discontinuity and according to the grasping method required. The palm-thumb distance is used to recognize the current grasping method. The reference of PSM in cartesian space is calculated as integration over time τ of the velocity components of the user hand centroid _ c h until the time instant t. In this way, during a temporary disconnection between the patient side and control side, the relocation of the palm in more ergonomic poses or in a Where the value of centroid changes according to method of grasping, in fact: Similarly, the orientation of the human hand is exploited to orient the PSM. To this end Euler angles in roll (α), pitch (β), and yaw (c) convention are computed as: being μ i,j,k the second order central moments of cloud of contact points We exploited a sphere as virtual object to easily project the human hand motions into MUSHA fingers and wrist movements. The roto-translations and deformations of a sphere can be completely defined by the following seven parameters: 1) o h ∈ R 3 Cartesian coordinate of the center of sphere; 2) θ h ∈ R 3 the orientation of the frame attached to the sphere with respect to the world frame, expressed as roll, pitch, and yaw angles; 3) r h ∈ R the sphere radius. Combining (13) and the aforementioned seven parameters, it is possible to obtain a linear relationship between human hand motions and sphere transformation Thus, there exists a Jacobian matrix J hs such that its pseudoinverse, J † hs , projects the human fingertip velocities into derivative parameters of the sphere: The resulting Jacobian matrix depends on the current position of interaction points of human hand and on the sphere center that is a function of the active points of the human hand. Indeed, the sphere center is the circumcenter of a triangle with three of the current interaction points as vertices. where Δ h,ki is the difference between the position vector of the k-th fingertip c h,k in contact with the sphere and the i-th fingertip c h,i , then, (23) can be rewritten as: As a further step towards the mapping, the sphere manipulated by the human is properly transformed into the one manipulated by the MUSHA through a scale factor K s , that is equal to the ratio between the radius of human and MUSHA manipulated spheres. The algorithm computes the Jacobian of the sphere manipulated by the robot (i.e., J rs ) and evaluates the velocities of the robotic fingertips, Velocities are estimated by a closed loop kinematic inversion where J w r , J rs and J hs are the Jacobian matrices of the robot, of the sphere manipulated by the robot, and of the sphere manipulated by the user, respectively. K c (p r − p r ) is the corrective action on the error between the current position of MUSHA interaction points p r and the desired onesp r , weighted by the gain K c . It is worth pointing out that the pseudo-inversion of J hs induces an indeterminacy in the estimated positions far from the current pose in case of multiple solutions, for this reason, the right position of the thumb in the retractor method may be not correctly computed. This situation is visually depicted in Figure 6 . A projection into the null-space of mapping actions is used to overcome this limitation. To this end, (27) is extended as follows, _ q r J w † r q r J rs p r K s J † hs p h IΩ _ p h + K cp r − p r + J w r I 6×6 − J rs K s J hs IΩ ( where being K Rt the gain that multiplies the error between current joint position q r and q Rt , the expected joint position in retractor pose. Regarding the initial condition, at the beginning of any task, the MUSHA lies in a rest position with all the fingers closed with joint configuration q r0 0 6×1 . This particular configuration results in a kinematic singularity, in fact when q(t) q r0 the rank of Jacobian of robot decreases, Rank(J w r ) < 6. For this reason, an initialization procedure is required. In accordance with arg max q det J w r q J wT r q q i,ρ ∈ q i,ρ min , q i,ρ max ∀i, ∀ρ we select q r 0 [0, π 9 , − π 9 , π 9 , − π 9 , − π 9 ] as initial position. It corresponds to the joint configuration with the maximum manipulability. In conclusion, combining (28-30), we obtain the entire human-MUSHA hand joints mapping: with _ q r J w † r q r J rs p r K s J † hs p h IΩ _ p h + K cp r − p r + J w r I − J rs K s J hs IΩ ( ) † J rs K s J hs IΩ The camera system LeapMotion (Ultraleap inc., United States) is used to acquire active points of human hand. This camera system is composed of two monochromatic IR cameras and three LEDs that observe a hemispherical area and capture snapshots of up to 200 frames per second, and it returns information about positions of some fixed notable points of acquired hand as tips of fingers, the center of palm and knuckles. A ROS node acquires these from LeapMotion and publishes the values of active points, selecting only those useful for the mapping algorithm. To test the control law a virtual model of MUSHA hand is imported in V-rep (Coppelia Robotics GmbH, CH), and here its kinematic and dynamic behavior is simulated. First of all, a theoretical analysis of applied forces is conducted to evaluate the effect of contact between MUSHA and a generic organic tissue for each method of grasp, then a validation of the control algorithm is pursued to demonstrate its stability. An experimental campaign follows, during which naive participants are asked to complete a pick and place operation using the virtual model of the MUSHA hand. During surgery, the grasping and manipulation of tissue may generate both internal and external forces. The former impresses deformation and allows to avoid the sliding of the manipulated tissue, the latter generates twists. In accordance with the grasping theory (Prattichizzo and Trinkle, 2016) , it is possible to evaluate from the applied force (i.e., λ) the components that generate the squeezing (i.e., ξ), and the ones that generate twisting (i.e., ω). This can be done by exploiting the grasping matrix G ∈ R 6×18 and the null space projector N G ∈ R 18×18 , following the relationship G T is the transposed grasping matrix that maps sources of twist from contact point reference to world reference. H is a selection matrix depending on the contact finger model. Considering the consistency of organic tissues, it is possible to approximate the grasp with the Soft Finger (SF) contact model. Interested reader is referred to Prattichizzo and Trinkle (2016) for further details. Therefore, admitting the applicability of the principle of kineto-static duality, it is possible to apply generalized forces exclusively in the directions of constrained motions. Directions of force application are shown in Figure 7 in case of contact with one finger. We assumed SF contact model for each point, thus the selection matrix H can be defined as Consequently, the complete grasp matrix G T can be modeled as G T HG T , being and where R T ∈ R 3×3 are the rotation matrices describing the orientation of each contact point reference frame Σ j , j T, I, M with respect to the world reference frame Σ O , S(c j − p ts ) is the cross-product matrix of the vector c j p ts , and p ts is center of mass of the grasped portion of tissue. Accounting the available grasping configurations, we can refine the general formula as follows: At each time instant, the position of the centroid of the manipulated tissues and the positions of the contact points may be known, so the grasping matrix can be computed and a projector in its null space can be evaluated: Thus, given measure of contact force,λ, the value of ξ and ω can be evaluated as: The stability of the proposed control law was assessed by Lyapunov conditions. To this aim, we choose as positive definite Lyapunov functions the function of error: Where ϵ is the distance between the actual (p r ) and desired ( p r ) MUSHA fingertip. Introducing (48) in (51), it is obtained that: Reintroducing (52) the error evaluated in accordance with (45), we obtain If MUSHA is accurately calibrated the Jacobian matrix evaluated on the real position of fingers and on the estimated one are approximately equal, J w r ≈ J w r , and the time derivative Lyapunov function becomes Since the Lyapunov function (47) is positive definite (V(t) > 0) and its time derivative is negative definite ( _ V(t) < 0), the system is Lyapunov stable. It is possible assert the BIBO stability, too. In fact, substituting definition of desired position (51) in control law (28), we obtain that It is possible to evaluate the tendency of error, using the definition of time derivative of error metric: The error evolves as first order linear system, so the Lyapunov stability implies the BIBO stability. Ten inexperienced participants (six males and four females, aged 24-59, all right-handed) took part in user studies. Each subject gave her/his consent to participate and was able to discontinue participation at any time during experiments. The experimental evaluation protocols followed the declaration of Helsinki, and there was no risk of harmful effects on subjects' health. Participants performed 10 pick-and-place tasks of two cubes with 10 different initial scenarios pseudo-randomly sorted. The experimental set-up is shown in 1 Figure 8 . The dimension of each cube is 0.02 m × 0.02 m×0.02 m and the weight is equal to 20 g. To help the participant to complete the task, force feedback is provided by two vibromotors NFP-C1234L to inform them about internal and external forces applied on cubes. The two components of force are evaluated starting from the results of Section 3.1 using (42) and (43), respectively, and their norms in ℓ 2 space, ξ and ω , are used to calculate the motor PWMs as: where ΔF is the range of forces that can be acquired through MUSHA hand force sensors (ΔF 4N). The dimension disparity between the internal force space (ξ ∈ R 18 ) and the external one (ω ∈ R 6 ) introduces an imbalance of haptic stimulus intensity which has been compensated by scaling the ℓ 2 norm ξ with a k-factor equal to the ratio of the dimensions of the two spaces (k 3). At the end of each session, a NASA Task Load Index questionnaire (TLX) (Hart, 2006) was proposed to the participants, with the aim of assessing the perceived load in terms of Mental Demand (MD), Temporal Demand (TD), Physical Demand (PD), Performance (PE), Effort (EF), and Frustration (FR). This method assesses workload on a pointbased scale. Each of the six questions has a scale of 21 levels, considering 1 as "very low" and 21 as "very high." Questions are reported in what follows: -Mental demand: "How mentally demanding was the task?" -Physical demand: "How physically demanding was the task?" -Temporal demand: "How hurried or rushed was the pace of the task?" -Performance: "How successful were you in accomplishing what you were asked to do?" -Effort: "How hard did you have to work to accomplish your level of performance?" -Frustration: "How insecure, discouraged, irritated, stressed, and annoyed were you?" All participants successfully completed the ten pick and place repetitions of the two cubes, so the completion times for each trial and the results of the questionnaires were considered as metrics for evaluation. Results are reported in Table 1 and Table 2 . The mean time to complete the task is 16.49 s and no participant took more than 30s. The load of the task performed with the proposed control law is evaluated from answers of the NASA TLX questionnaire and its mean value is equal to 35%. According with the proposed task and experimental set-up we used the following weights: w MD 3, w PD 0, w TD 5, w PE 1, w FR 3, w EF 3. The physical demand was excluded from task load evaluation (PD 0) because the physical load is due to the absence of arm support that is provided by the surgeon console in a real scenario. In this work, we present a reliable and intuitive method for the bilateral asymmetric teleoperation of the MUSHA hand. A camera-based device is in charge of tracking the human hand, and a mapping algorithm projects the human motion in the endeffector actuation space through the virtual object domain. The developed technique consists in a remote control for the projection of the human gestures into the robot space of actuation by crossing the object domain and switching in the function of the current gripping method, which is recognized online by the posture of the user's hand. A sphere is chosen as virtual objects due to the reduced number of parameters that describe its pose and deformation. A closed-loop inverse kinematic algorithm makes more robust the control action and guarantees the BIBO stability of the algorithm, while a projection in the null of the object space allows the correct estimation of indeterminate poses. Starting from the kinematics description of the MUSHA hand and its main grasping methods, we theoretically evaluated the grasping forces applied by the tool during each method and an experimental campaign assesses the functionality and the usability of the algorithm. All the participants completed the assigned task in less than 30 s (15 s per cube) with a limited cognitive load. The obtained results demonstrate the intuitiveness of the teleoperation system. The proposed control algorithm has been designed, developed, and tested to control the MUSHA hand, nevertheless it can be generalized and extended to different grippers and robotic hands. Indeed the proposed methodology relies on a mapping algorithm that exploits contact points and grasping methods. Thus, a redefinition of the differential kinematic equations and of the related Jacobian Matrix of the gripper allow the reader adapting the algorithm to the hand of interest. A preliminary analysis of the instrument grasping capacity and the redefinition of the selection vector, Ω, allows to maintain the validity of the theoretical results regarding the evaluation of the applied forces. In future work, experiments will be conducted considering expert users asking them to complete elementary surgical procedures using the real MUSHA hand mounted on the da Vinci robot and we will test the compatibility of the algorithm with several standard end-effector during the same procedures. Finally, the entire system will be integrated with the surgeon console of the da Vinci robot. Medical Robots: Current Systems and Research Directions Model Based Control Algorithms for Robotic Assisted Beating Heart Surgery Active Constraints/virtual Fixtures: A Survey A Laparoscopic Telesurgical Workstation Current Evidence for Minimally Invasive Surgery during the COVID-19 Pandemic and Risk Mitigation Strategies Switched-impedance Control of Surgical Robots in Teleoperated Beating-Heart Surgery Modelling and identification of the da vinci research kit robotic arms A v-rep simulator for the da vinci research kit robotic platform Mapping Synergies from Human to Robotic Hands with Dissimilar Kinematics: an Approach in the Object Domain System Integration of Neurobot: a Skull-Base Surgical Robotic System Efficacy and Safety of Minimally Invasive Surgery with Thrombolysis in Intracerebral Haemorrhage Evacuation Open-Label, Blinded Endpoint Phase 3 Trial Nasa-task Load index (Nasa-tlx); 20 Years Later Design of a Haptic Device with Grasp and Push-Pull Force Feedback for a Master-Slave Surgical Robot Model-based Analysis of Hand Posture Design of Master Console Haptic Handle for Robot Assisted Laparoscopy Robotic versus Standard Laparoscopic Elective Colectomy: where Are the Benefits? Davinci Canvas: a Telerobotic Surgical System with Integrated, Robot-Assisted, Laparoscopic Ultrasound Capability Gesto: A Glove for Enhanced Sensing and Touching Based on Inertial and Magnetic Sensors for Hand Tracking and Cutaneous Feedback Design of the Musha Hand Ii for Robotic-Assisted Laparoscopic Surgery The Musha Hand Ii: A Multi-Functional Hand for Robot-Assisted Laparoscopic Surgery The Black falcon: a Teleoperated Surgical Instrument for Minimally Invasive Surgery A Teleoperation System for Micro-invasive Brain Surgery. Paladyn Intuitive Hand Teleoperation by Novice Operators Using a Continuous Teleoperation Subspace Sensory Subtraction in Robot-Assisted Surgery: Fingertip Skin Deformation Feedback to Ensure Safety and Improve Transparency in Bimanual Haptic Interaction Vision-based Dynamic Virtual Fixtures for Tools Collision Avoidance in Robotic Surgery Bimanual Telerobotic Surgery with Asymmetric Force Feedback: a Davinci ® Surgical System Implementation Stable Adaptive Teleoperation Haptic Feedback in Robot-Assisted Minimally Invasive Surgery Minimally Invasive Surgery for Gastric Cancer: A Comparison between Robotic, Laparoscopic and Open Surgery Clinical Benefits of Minimally Invasive Techniques in Thyroid Surgery Grasping Trends in the Adoption of Robotic Surgery for Common Surgical Procedures Role of robotic gastrectomy using da vinci system compared with laparoscopic gastrectomy: initial experience of 20 consecutive cases Minimally Invasive Surgery and its Impact on 30-day Postoperative Complications, Unplanned Readmissions and Mortality Image Overlay Navigation by Markerless Surface Registration in Gastrointestinal, Hepatobiliary and Pancreatic Surgery Design of Master Console Robot for Natural Orifice Transluminal Endoscopic Surgery Augmented Reality-Guided Neurosurgery: Accuracy and Intraoperative Application of an Image Projection Technique Open-source Research Platforms and System Integration in Modern Surgical Robotics. Acta Universitatis Sapientiae Motion Control of a Master-Slave Minimally Invasive Surgical Robot Based on the Hand-Eye-Coordination The Role of Technology in Minimally Invasive Surgery: State of the Art, Recent Developments and Future Directions The SEP "robot": a Valid Virtual Reality Robotic Simulator for the Da Vinci Surgical System? Augmented Reality and Haptic Interfaces for Robot-Assisted Surgery Force Model-Based Haptic Master Console Design for Teleoperated Minimally Invasive Surgery Application It is possible to evaluate its time derivative value as:Consequently, the time derivative of the Lyapunov function isWhere J w r is the Jacobian matrix of model of MUSHA hand evaluated in real current position. Substituting (28) in (47), the derivative Lyapunov function becomesWhere M is the mapping action of control lawand N M is the projection action in null space of M used to overcome the duality of thumb pose in retractor method:The desired velocity _ p r is chosen as the result of mapping M(q r , p r , p h ) and projection in null space of mapping N M , The raw data supporting the conclusion of this article will be made available by the authors, without undue reservation. Ethical review and approval was not required for the study on human participants in accordance with the local legislation and institutional requirements. The patients/participants provided their written informed consent to participate in this study. FF and DP were project coordinators, they contributed to conception and design of the study. AV and TL worked on the experimental setup and runned the experiments. FF, AV, and DP proposed algorithm and supervised the experiments. FF, AV, and TL were principal investigators, and wrote the manuscript. All authors contributed to manuscript revision, read, and approved the submitted version. This project has received funding from the European Union's Horizon 2020 research and innovation programme under grant agreement No 101017008. The Supplementary Material for this article can be found online at: https://www.frontiersin.org/articles/10.3389/frobt.2021.741807/ full#supplementary-material Conflict of Interest: The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.