<figure><img src="image_1.png" /></figure>

HAL
open science

# Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation

Houssem Saafi, Med Amine Laribi, Said Zeghloul

► To cite this version:

Houssem Saafi, Med Amine Laribi, Said Zeghloul. Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation. Robotics, 2020, 9 (3), pp.62. 10.3390/robotics9030062. hal-03176751

HAL Id: hal-03176751

https://hal.science/hal-03176751

Submitted on 8 Jul 2021

HAL is a multi-disciplinary open access
archive for the deposit and dissemination of sci-
entific research documents, whether they are pub-
lished or not. The documents may come from
teaching and research institutions in France or
abroad, or from public or private research centers.

L'archive ouverte pluridisciplinaire HAL, est
destinée au dépôt et à la diffusion de documents
scientifiques de niveau recherche, publiés ou non,
émanant des établissements d'enseignement et de
recherche français ou étrangers, des laboratoires
publics ou privés.

<figure><img src="image_2.png" /></figure>

Distributed under a Creative Commons Attribution 4.0 International License
<figure><img src="image_3.png" /></figure>

Article

# Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation †

Houssem Saafi<fnref n="1" />,<fnref n="2" /> ID, Med Amine Laribi<fnref n="3" />,* ID and Said Zeghloul<fnref n="3" />

Received: 25 June 2020; Accepted: 3 August 2020; Published: 6 August 2020

<figure><img src="image_4.png" /></figure>

check for
updates

**Abstract:** This paper deals with a special architecture of Spherical Parallel Manipulators (SPMs) designed to be a haptic device for a medical tele-operation system. This architecture is obtained by replacing the kinematic of one leg of a classical 3-RRR SPM (R for revolute joint). The Forward Kinematic Model (FKM) is particularly addressed to allow the new master device to control the motion of a slave surgical robot. For this purpose, three methods are presented to solve the FKM and compared based on the criterion of time consuming and accuracy. For each method, namely, classic FKM, Improved method and serial FKM, the resolution procedure is detailed and the experimental validation is presented. After comparison, the serial approach involving the use of three sensors located on one leg of the master device is revealed as the most suitable. Experimental validation of the real-time motion control is successfully performed using the serial FKM.

**Keywords:** spherical parallel manipulator; forward kinematic model; minimally invasive surgery; real-time; sensors

## 1. Introduction

Haptic devices are systems used to increase the user's immersion for different applications, such as gaming [1], medicine [2,3] and virtual reality [4,5]. Furthermore, they are used for tasks where visual information is not sufficient; for example, the manipulation of radioactive objects. Parallel architecture has been selected to develop many haptic devices due to their performances: high stiffness, load capability and low weight. Spherical parallel manipulators (SPMs), that have a fixed Center of Rotation (CoR), are a class of parallel mechanisms providing three degrees of freedom of pure rotation. Some haptic devices with a parallel spherical structure have been developed, such as the haptic device proposed by Birglen et al. [6] to control the orientation of a camera [7] and the haptic device proposed by Saafi et al. [8] for medical teleoperation system to control a slave robot.

The kinematic performance of Parallel Manipulators (PMs), as well as its dynamic behaviour, depend on its dimensional synthesis. Many recent works focus on the design of PMs. Saafi et al. [9] compared two optimally designed parallel manipulator: redundant 2-DoF PM and non-redundant one. This work showed that the non-redundant and optimally designed is a better choice for haptic uses. Ben Hamida et al. [10] presented an approach based on a multi-objective optimization for dimensional

<footnote n="1">¹ Mechanical Laboratory of Sousse (LMS), National Engineering School of Sousse, University of Sousse, Sousse 4000, Tunisia; houssem.saafi@gmail.com</footnote>

<footnote n="2">² Preparatory Institute for Engineering Studies of Gafsa, University of Gafsa, Gafsa 2000, Tunisia</footnote>

<footnote n="3">³ Department of GMSC, Prime Institute, CNRS—University of Poitiers, ENSMA—UPR 3346, 86073 Poitiers, France; said.zeghloul@univ-poitiers.fr</footnote>

<footnote>* Correspondence: med.amine.laribi@univ-poitiers.fr</footnote>

<footnote>† This paper is an extended version of our paper published in Saafi, H.; Laribi, M.A.; Zeghloul, S. Real-Time Resolution of the Forward Kinematic Model for a New Spherical Parallel Manipulator. In Proceedings of the IFTOMM International Symposium on Robotics and Mechatronics, Taipei, Taiwan, 28–30 October 2019.</footnote>
parameter identification of four types of translational parallel manipulators (PMs). These PMs are Delta, 3-UPU, RAF, and Tri-pyramid Robots. The optimisation approach allows to identify suitable optimal solutions with compromises. More studies [11–13] have focused on this issue and concluded that the equilibrium between criteria such as dexterity and workspace is difficult to reach.

The SPM, like many parallel robots, suffer from parallel singularities. This type of singularity may appear at the center of the workspace and generates large actuator torques and a loss of stiffness. In singular configurations, a parallel manipulator loses one or more of its degrees of freedom. Several works have tried to eliminate this type of singularity from the workspace of the parallel robot by optimizing its geometry [14,15], but by improving the kinematic behavior, the parallel robot structure becomes bigger and a problem of interference is generated [7]. Other works addressed the singularity issues and the complexity of forward kinematic model of the SPM by proposing the use of redundancy.

The first prototype of the haptic device has a classical spherical parallel architecture (Figure 1a). The self-rotation was not considered in the optimization process and this induces the presence of the parallel singularities inside the workspace of the SPM. The parallel singularity has negative effects on the manipulator behavior. Thus, the kinematic transformation from the Joint space to the Cartesian space is disturbed by errors amplification. Further, the torques of the actuated joints are amplified. To cope with these problems several solutions based on redundancy have been proposed. The first solution is focused on the improvement of the accuracy of the FKM in singular region by using an additional sensor [16]. This solution has allowed the simplification of the kinematic model and reducing the computing time. The second solution is focused on the use of a redundant actuator to avoid the exceed of torque limits [17]. The two solutions have solved the issues of parallel singularities. However, the additional actuator increases the weight of the moving platform.

<figure><img src="image_5.png" /><figcaption>**Figure 1.** Haptics devices: (a) First Prototype, (b) Second prototype.</figcaption></figure>

In this paper, a new prototype of the master device, with partial kinematic change, is studied (Figure 1b). Only one leg of the classical Spherical Parallel Manipulator is modified by URU architecture (U for Universal joint and R for Revolute joint). Yet, the spherical motion is ensured by the two other legs with RRR architecture. The resolution of the forward kinematic model of this new master device as well as the real-time issue is developed in this paper. Three approaches are compared. The most suitable one is chosen and implemented to control the motion of the surgical slave robot. This approach
is based on computing the FKM of a serial RRR leg of the special SPM. This method is implemented in the control system and is tested experimentally by an expert surgeon.

The paper is organized as follows: Section 2 focuses on the presentation of the tele-operation system in the context of minimally invasive surgery. In Section 3, the kinematic of the new spherical parallel manipulator is presented. The behavior improvement as well as the singularity free workspace are discussed. Section 4 presents the three proposed methods to solve the forward kinematic model. Section 5 presents the experimental comparison between the three proposed methods. Validations of the proposed real-time method and the tele-operation system are carried-out in Section 6. Conclusions and perspectives are presented in Section 7.

## 2. Tele-Operation System

In the medical field, tele-operation systems are not designed to yield autonomous operation but to assist the expert by adding more security and accuracy to the medical operation. The proposed tele-operation system is dedicated for Minimally Invasive Surgery (MIS) performed through small incisions. The instruments in MIS are designed to enter into the patient body through tiny incision points by a trocar, see Figure 2. In this kind of medical intervention, motions of the instruments are limited to three rotations around the incision point and one translation within the instrument axis.

<figure><img src="image_6.png" /><figcaption>**Figure 2.** MIS possible movement.</figcaption></figure>

The surgeons are therefore called to learn a new form of hand-eye coordination and to become skillful in the manipulation of instruments. The use of these latter from the outside of the body made possible robotizing this technique. A robot, operating on a distant patient, is then controlled by an expert surgeon through a haptic interface. The latter device should be able to reproduce the expert movement with high transparency and provide a force rendering, that one calls a tele-operation system. A Tele-operation system synoptic is represented in Figure 3. It's important to highlight that nowadays no commercial system is providing haptic feedback and the force rendering is still focused in research purpose.
<figure><img src="image_7.png" /><figcaption>Figure 3. Tele-operation system synoptic.</figcaption></figure>

A PROMIS (Pprime RObot for Minimally Invasive Surgery) system is designed for collaborative operation between the surgeon and the robot. This system is composed of a master device and a slave device as is shown in Figure 4. The surgical robot has a RRR spherical serial structure with a prismatic joint at the end. Its kinematic was optimized to get a compact structure. The tool is held by an effector with two DoFs: self rotation and opening/closing. This paper focuses on the study of the master device. Its kinematic is studied in the next sections.

<figure><img src="image_8.png" /><figcaption>Figure 4. Pprime Robot for Minimally Invasive Surgery: (a) Developed Master Station, (b) Developed Slave Station.</figcaption></figure>

### 3. Kinematic of the Modified Spherical Parallel Manipulator

The kinematic model of the spherical parallel manipulator is as follows:

$$A \cdot \omega = B \cdot \dot{\theta} \qquad (1)$$

where, $\omega$ is the angular velocity of the moving-platform, $\dot{\theta}$ is the angular velocity of active joint, A is the parallel part of the Jacobian matrix and B is the serial part of the Jacobian matrix. The two matrices A and B are 3 × 3.
The Jacobian matrix of parallel manipulators is as follows:

$$J = A^{-1} \times B \qquad (2)$$

Parallel singularity appears when the determinant of the matrix A vanishes. This appears when the three columns of the matrix A are linearly dependents. Each column of the matrix A corresponds to one leg of the parallel robot. In order to eliminate the parallel singularity from the workspace of the spherical parallel manipulator, the kinematic of one leg is changed. One leg with RRR architecture is replaced by a leg with URU architecture (R for Revolute joint and U for Universal Joint). Two legs are kept the same in order to maintain the spherical behavior of the device. The New SPM has three degrees of freedom of pure rotation described by the Euler angles $\psi, \theta$ and $\varphi$. The kinematic of the new manipulator is presented in Figure 5. Figure 6 shows the kinematic of the two legs. The RRR leg (Figure 6a) has two links: the first one is defined by the angle $\alpha$ and the second link is defined by the angle $\beta$. Moreover, the angle $\gamma$ is the angle between $Z_{3k}$ ($K = B, C$) and $Z_E$ (the center of the end-effector). Birglen et al. [6] proposed a similar architecture to eliminate interference between legs for the haptic device.

<figure><img src="image_9.png" /><figcaption>Figure 5. Architecture of the special Spherical parallel manipulator.</figcaption></figure>

The kinematic model of the haptic device can be written as follows. For the leg B and C, we can write:

$$Z_{2k} \cdot Z_{3k} = \beta \quad \text{with, } (k = B, C) \qquad (3)$$

This equation can be obtained since the scalar product of two vectors is the cosine of the angle between them. And, as illustrated in Figure 6a, the angle between $Z_{2k}$ and $Z_{3k}$ is $\beta$.

By differentiating the Equation (3), we get:

$$\dot{Z}_{2k} \cdot Z_{3k} + Z_{2k} \cdot \dot{Z}_{3k} = 0 \qquad (4)$$

with,

$$\dot{Z}_{2k} = \dot{\theta}_{1k} Z_{1k} \times Z_{2k} \quad ; \quad \dot{Z}_{3k} = \omega \times Z_{3k} \qquad (5)$$

with, $\omega$ is the angular velocity of the moving platform. The kinematic model of leg B and C is as follows:

$$\dot{\theta}_{1k} Z_{1k} \times Z_{2k} \cdot Z_{3k} = \omega \cdot Z_{2k} \times Z_{3k} \qquad (6)$$
<figure><img src="image_10.png" /><figcaption>Figure 6. Geometric parameters: (a) RRR leg, (b) URU leg.</figcaption></figure>

For the leg A with the new architecture, we have:

$$ \omega = \dot{\theta}_{1k}Z_{1k} + \dot{\theta}_{2k}Z_{2k} + \dot{\theta}_{3k}Z_{3k} + \dot{\theta}_{4k}Z_{4k} + \dot{\theta}_{5k}Z_{5k} \quad (7) $$

To get a relation between $\omega$ and the active angle $\theta_{1A}$, Equation (7) is multiplied by the vector $V_r$ orthogonal to $Z_{2A}$, $Z_{3A}$, $Z_{4A}$ and $Z_{5A}$. We obtain:

$$ V_r \cdot \omega = \dot{\theta}_{1A}V_r \cdot Z_{1A} \quad (8) $$

with,

$$ V_r = Z_{4A} \times Z_{5A} \quad (9) $$

The matrices **A** and **B** are as follows:

$$ \mathbf{A} = \begin{bmatrix} (Z_{5A} \times Z_{4A})^T \\ (Z_{3B} \times Z_{2B})^T \\ (Z_{3C} \times Z_{2C})^T \end{bmatrix} \quad (10) $$

$$ \mathbf{B} = \begin{bmatrix} (Z_{5A} \times Z_{4A}) \cdot Z_{1A} & 0 & 0 \\ 0 & (Z_{3B} \times Z_{2B}) \cdot Z_{1B} & 0 \\ 0 & 0 & (Z_{3C} \times Z_{2C}) \cdot Z_{1C} \end{bmatrix} \quad (11) $$

The dexterity can be used to evaluate the presence of the singularity in the workspace of the parallel robot. The dexterity is expressed as follows:

$$ \eta(\mathbf{J}) = \frac{1}{\kappa(\mathbf{J})} \quad (12) $$

where $\kappa(\mathbf{J})$ is the condition number of the Jacobian matrix. It has the following expression:

$$ \kappa(\mathbf{J}) = \|\mathbf{J}\| \cdot \|\mathbf{J}^{-1}\| \quad (13) $$

The dexterity distributions for $\varphi = -50^{\circ}$, $\varphi = 0^{\circ}$ and $\varphi = 50^{\circ}$ are presented in the Figure 7. The distribution shows that there are no singularities in the workspace of the New SPM and especially at its center. After this stage, a real master device has been developed (Figure 1b). The prototype was equipped with sensors and actuators. This prototype is designed to control the motion of the surgical
robot. For this, we need to solve the Forward Kinematic model of the new SPM in Real-Time. In the next section, we discuss the resolution of the Forward Kinematic Model.

<figure><img src="image_11.png" /><figcaption>Figure 7. Dexterity distributions for three values of φ.</figcaption></figure>

## 4. Methods to Solve the FKM

Three methods have been detailed in this paper to solve the direct model of the proposed SPM. Three sensors fixed on the base are used in the first method, called classic FKM. Four sensors, three on the base and one on a passive joint of the moving platform, are used in the second method and called improved FKM. The third method uses three sensors on one leg and installed in serial configuration, called serial FKM.

### 4.1. Classical Method to Solve the Forward Kinematic Model

The FKM expresses the orientation of the moving platform described by the Euler angle (ψ, θ, φ), using the active joint angles (θ₁A, θ₁B, θ₁C). Bai et al. [18] proposed a method based on the input/output equations of spherical four-bar mechanisms to solve the FKM of the classical SPM. This approach is adapted to the modified SPM. Only one loop describing the spherical four-bar mechanism is given. This closed loop is passing by the second link of the legs B, the moving platform (between Z₃B and Z₃C axes), the second link of the legs C and finally, a fictive link between the joints with axis Z₂B and the axis Z₂C (see Figure 8). As for the planar four-bar mechanisms, the spherical one has a geometrical equation relating two angles called input/output angles. This two angles are ζ and σ (Figure 8).

The input/output equation of the spherical four-bar mechanism is defined as:

$$L_1(\xi)\cos\sigma + M_1(\xi)\sin\sigma + N_1(\xi) = 0 \qquad (14)$$

where L₁, M₁ and N₁ are functions of cosζ and sinζ.

This equation is detailed in [16,18]. A second equation is needed to solve the FKM of this SPM. This equation is given by the scalar product of vectors Z₅A and Y₁A as follows:

$$Z_{5A} \cdot Y_{1A} = 0 \qquad (15)$$

with,

$$\left\{ \begin{array}{l} Z_{5A} = R_{0B}R_{Z}(\theta_{1B})R_{X}(\alpha)R_{Z}(\xi + \xi')R_{X}(\beta)R_{Z}(\sigma - \mu)R_{X}(\gamma)R_{Z}(2\pi/3)R_{X}(-\gamma)Z \\ Y_{1A} = R_{Z}(\theta_{1A})Y \end{array} \right. \qquad (16)$$

Z₅A is orthogonal to Y₁A because Z₅A is in the plan formed by Z₁A and X₁A (see Figure 6b).

After arrangement, we get the following expression:

$$L_2(\xi)\cos\sigma + M_2(\xi)\sin\sigma + N_2(\xi) = 0 \qquad (17)$$
where $L_2$, $M_2$ and $N_2$ are functions of $cos\xi$ and $sin\xi$. The expressions of $cos\sigma$ and $sin\sigma$ are computed using Equations (14) and (17) as follows:

$$cos\sigma = \frac{M_1N_2 - M_2N_1}{L_1M_2 - L_2M_1} \quad ; \quad sin\sigma = -\frac{L_1N_2 - L_2N_1}{L_1M_2 - L_2M_1} \quad (18)$$

<figure><img src="image_12.png" /><figcaption>Figure 8. Spherical four-bar mechanism (one closed loop).</figcaption></figure>

The equation with $\xi$ as unknown can be obtained through a square sum of $cos\sigma$ and $sin\sigma$:

$$N_2^2 L_2^2 + 2L_1 M_1 L_2 M_2 - 2L_1 N_1 L_2 N_2 + N_2^2 M_1^2 - L_2^2 M_1^2 - 2M_1 N_1 M_2 N_2 - M_2^2 L_1^2 - N_1^2 L_2^2 - N_1^2 M_2^2 = 0 \quad (19)$$

Equation (19) allows to compute all solutions of $\xi$ after a rewritten to 8th degree polynomial transformation using the tan-half identities technique, $x = tan(\xi/2)$, [19]. Euler angles, orientation of the moving platform, can be identified by solving the forward kinematic of the leg B. Here, Equation (18) is used to identify the solutions of $\sigma$.

To determine the orientation of the end-effector, the direct serial model of leg B is used. Since, the angle $\theta_{1B}$ is directly given by the sensor and the angles $\theta_{2B}$ and $\theta_{3B}$ may be calculated using the angles, $\xi$, and, $\sigma$, ($\theta_{2B} = \xi + \xi'$ and $\theta_{3B} = \sigma - \mu$).

The estimated consuming time of this FKM is about 100 µs on a processor running at 3.16 GHz. this can be justified by complexity of the Equation (19). To cope with this slowness, we proposed in previous work [16] the use of an extra sensor which allowed to reach a double purposes: speed-up the calculation time and improving the accuracy of the FKM for the classical SPM. The extra-sensor method is applied here to the modified SPM in the next section.

## 4.2. Improved Method to Solve the Forward Kinematic Model

The technique of adding extra sensors in passives joints is studied in [16,20]. It has the advantage of giving a fast and direct solution to the FKM. As illustrated in the previous paragraph, two variables ($\sigma$ and $\xi$) are required to solve the forward kinematic of this parallel manipulator (see Figure 8). Here, a fourth sensor is included to the control system and installed on the axis $Z_{3B}$. The values of angle
$\sigma$ became known in Equations (14) and (17). The FKM has one unknown variable, the angle $\zeta$, and the problem can be reformulated as follows:

$$ \left\{ \begin{array}{l} \bar{L}_1 \cos \zeta + \bar{M}_1 \sin \zeta + \bar{N}_1 = 0 \\ \bar{L}_2 \cos \zeta + \bar{M}_2 \sin \zeta + \bar{N}_2 = 0 \end{array} \right. \qquad (20) $$

where $\bar{L}_i$, $\bar{M}_i$ and $\bar{N}_i$ ($i = 1, 2$) are variables that depend on $\cos\sigma$ and $\sin\sigma$ and obtained by arranging Equations (14) and (17).

The angle $\zeta$ is given by the following expression:

$$ \zeta = \operatorname{atan2}(\sin\zeta, \cos\zeta) \qquad (21) $$

with,

$$ \cos\zeta = \frac{\bar{M}_1\bar{N}_2 - \bar{M}_2\bar{N}_1}{\bar{L}_1\bar{M}_2 - \bar{L}_2\bar{M}_1}, \qquad \sin\zeta = -\frac{\bar{L}_1\bar{N}_2 - \bar{L}_2\bar{N}_1}{\bar{L}_1\bar{M}_2 - \bar{L}_2\bar{M}_1} \qquad (22) $$

This method gives a direct and unique solution to the FKM. However, the expression of $\bar{L}_2$, $\bar{M}_2$ and $\bar{N}_2$ are very complex. In fact, $\bar{L}_2$, for instance, contains 219 $\cos$ or $\sin$ operations. This increases considerably the calculation time. Furthermore, this method requires the use of four sensors instead of three sensors.

The next paragraph deals with a serial method of solving the FKM.

### 4.3. Serial Method to Solve the Forward Kinematic Model

For this approach, only one RRR leg is considered to solve the FKM and to determine the orientation of the moving platform. Figure 9 presents one leg of the SPM equipped with three sensors.

<figure><img src="image_13.png" /><figcaption>Figure 9. Leg B with three sensors.</figcaption></figure>

The orientation of the end effector, the moving platform, can be expressed using the serial forward model of the leg B as follows:

$$ M_o = R_{0B}R_Z(\theta_{1B})R_X(\alpha)R_Z(\theta_{2B})R_X(\beta)R_Z(\theta_{3B})R_X(\gamma)R_Z(\frac{2\pi}{3}) \qquad (23) $$

The previous methods use the serial approach to determine the orientation of the end-effector. However, the angles $\theta_{2B}$ and $\theta_{3B}$ are calculated using the angles $\zeta$ and $\sigma$. For the case of the serial
approach, $\theta_{2B}$ and $\theta_{3B}$ are given directly by sensors. This simplifies dramatically the processing time of the FKM.

Experimental evaluation and comparison of the three detailed methods are presented in the next section.

## 5. Experimental Comparison of the FKM Resolution

The previous methods are implemented using C++ language on a PC with a processor running at 3.16 GHz. The Table 1 presents the calculation times of the methods.

<table><caption>Table 1. Calculation time of the three methods.</caption><thead><tr><td>FKM Model</td><td>Calculation Time</td><td>Sensor</td></tr></thead><tbody><tr><td>Classic</td><td>≈90 µs</td><td>3 sensors in the base</td></tr><tr><td>Improved</td><td>≈60 µs</td><td>4 sensors</td></tr><tr><td>Serial</td><td>≈15 µs</td><td>3 sensors in the leg B</td></tr></tbody></table>

The serial method is faster than the other methods and the obtained calculation time, as shown in Table 1, is divided by 4 compared to the improved method.

The experimental study is performed using a prototype of the modified spherical manipulator presented in Figure 1b. The orientation of the moving platform is computed via each method. Here, all sensors are calibrated by blocking the moving platform in a reference configuration. All sensors are related to acquisition card, National Instrument card, installed on a PC based controller. The self-rotation of the moving platform is chosen to be fixed to evaluate the quality of the three methods through a random trajectory by changing the orientation. This strategy aims to compare the accuracy of the computed orientation. Obviously, the angle $\varphi$ should be equal to zero. The joint with axis $Z_{5A}$ is sealed using an elastic pin.

The orientation of the moving platform is given in Figure 10. The self-rotation is equal to zero and if there is possible deviation, then the FKM presents an error. In order to deeply investigate these models, the error distribution is computed for each method and as a result we obtained the curves in Figure 11. One observes that the serial FKM is the less accurate method but with no significant gap.

<figure><img src="image_14.png" /><figcaption>Figure 10. Orientation of the moving platform.</figcaption></figure>
<figure><img src="image_15.png" /><figcaption>**Figure 11.** Error Distributions for the tree models.</figcaption></figure>

The Table 2 shows the parameters of the distribution of each model. The mean value of the distribution corresponds to the calibration errors and the standard deviation corresponds to sensitivity of the model related to the sensor errors. The errors of the improved FKM and the classical FKM are very close because there is no parallel singularity in the workspace of new SPM. With no change in the control system, the serial FKM presents a suitable solution to offer a better computation time despite its loss of accuracy.

<table><caption>**Table 2.** Parameters of the distribution of each model.</caption><thead><tr><td>FKM Model</td><td>Mean Value</td><td>Standard Deviation</td></tr></thead><tbody><tr><td>Classic</td><td>0.182°</td><td>0.193°</td></tr><tr><td>Improved</td><td>0.178°</td><td>0.196°</td></tr><tr><td>Serial</td><td>0.276°</td><td>0.229°</td></tr></tbody></table>

On the one hand, the serial FKM requires the use of only three sensors as the case of the classical one, therefore, no additional cost is required. Furthermore, its computing time is six times less than the classical method which leaves a lot of room for the haptic calculation. On the other hand, it is true that the serial method is the least precise, however, it is important to mention that this method is used in existing tele-operation systems with spherical serial master devices such as the “da Vinci” surgical robotic system [21] and the master device designed by Van den Bedem et al. [3]. The precision of the serial method can be enhanced by improving the calibration procedure. This subject will be carried out in future works.
# 6. Experimentation Using the TeleOperation System

## 6.1. Motion Control Model

The master device is designed to control the motion of the surgical robot. The motion control scheme is presented in Figure 12. The main control unite is a PC Station. An application was developed to calculate the orientation of the new master device using the sensor data collected using an acquisition card. Then, the corresponding slave orientation is determinate using a transformation method [22]. Finally, the slave active joint motions are solved using the Inverse Kinematic Model of the slave robot. The slave data are transferred to a PLC (the Galil(c) Controller) which controls in real-time the motion of the slave robot.

The Serial Forward Kinematic model of master was implemented in the application. An experimental validation of the control is described in the next paragraph.

<figure><img src="image_16.png" /><figcaption>Figure 12. Motion control scheme.</figcaption></figure>

## 6.2. Experimental Test

The tele-opertation system is composed of two master devices and two surgical robots. The experiments involved using the teleoperation system to perform sutures on a hollow model simulating a human artery (Figure 13). The suturing method, called anastomosis, consists on the surgical union of two separated hollow organs. The technique is made of three phases beginning by
the suture of the back hemisphere, the suture of the front hemisphere and the triple knot, respectively. Figure 14 shows these three phases on a prosthetic aorta.

<figure><img src="image_17.png" /><figcaption>Figure 13. Hollow model of an artery.</figcaption></figure>

<figure><img src="image_18.png" /><figcaption>Figure 14. Anastomosis phases.</figcaption></figure>

The expert surgeon manipulated the master device to control the surgical robots and to handle the needle (Figure 15). It took some time for the surgeon to adapt to the use of the system and to acquire spatial depth perception using the 2D screen.

The surgeon was able to perform sutures using the teleoperation system as shown in Figure 16. The use of the robot made the procedure more comfortable for the surgeon. The surgeon reports, after the first experimentations, that the proposed system presents more efficiency than other existing systems. This is coming from the fact that no training session is requested. The system is handled promptly. The operating behavior does not change, and the surgeon manipulates in case of the proposed system instruments as a classic operation. The portability of the system is coming from the fact that no need to any infrastructure modification. The whole system is fixed on a table. In addition, the small size and the ergonomics of the developed tele-operation system make distance surgical operations possible.
<figure><img src="image_19.png" /><figcaption>**Figure 15.** An experiment being carried out by the surgeon.</figcaption></figure>

The duration of the suturing experiments at first experimentation is greater than one of the classic operations (manual procedure without the use of tele-operation robots) and will be optimized in future experimentation. Forthcoming work in collaboration with surgeons will be focused on the definition of performance criteria to evaluate the suturing. The suturing quality seems to be satisfactory for preliminary experimentation using the master/slave system and will be enhanced for the future version.

The expert surgeon highlighted some enhancements. Firstly, the choice of a parallel spherical structure for the master devices is the most appropriate because of the required motion and its rigidity. However, the self-rotation was slightly limited in border regions of the workspace. Secondly, the placement of the two surgical robots needs adjustment for better needle handling. This issue will be solved by the development of adjustment robotic system in future work. Thirdly, the surgeon proposed that the closing pressure force of the instrument may be increased to make the handling more stable. Finally, the slave surgical robot was close to its singular region. The issue is due to the non-optimal placement of the robot and its reduced workspace. Some modifications are therefore being carried out to develop a second prototype of the tele-operation system that meets the requirement of the surgical gestures.

In addition, the expert surgeon did not raise any problems related to a possible lack of the FKM accuracy. However, this issue is complex since it depends on the surgeon experience, the master device as well as the visual feedback. Future work will focuses on the quantification of the accuracy for the surgical operation using the proposed tele-operation systems.

<figure><img src="image_20.png" /><figcaption>**Figure 16.** Sutures performed using the teleoperation system.</figcaption></figure>

## 7. Conclusions

In the present work, a new spherical parallel manipulator, with a singularity-free workspace, was studied. This manipulator is used as a master haptic device for a surgical tele-operation system.
This device is developed to control the motion of a surgical robot in real-time. Three methods of the Forward Kinematic were studied and compared. The comparison has shown that the faster model is the one using three sensors installed on one serial leg. This model was implemented in the motion control algorithm. An experimental test was carried out using the developed tele-operation system. Some issues were raised during the experiment by the surgeon. Future works will focus on the enhancement of the tele-operation system. A new prototype of the master device that solves the issue of the self-rotation, will be developed. A new effector that offer butter closing torque will be designed. Finally, the implementation of force control is under development and new experiments with the surgeon will be carried out soon.

**Author Contributions:** H.S. and M.A.L. have designed the experiments and co-wrote the paper; the research work has been supervised by S.Z. All authors have read and agreed to the published version of the manuscript.

**Funding:** This research was also supported by the French region "Nouvelle-Aquitaine" (program HABISAN 2015-2020) with the financial participation of the European Union (FEDER/ERDF, European Regional Development Fund).

**Acknowledgments:** This work was sponsored by the French government research program Investissements d'avenir through the Robotex Equipment of Excellence (ANR-10-EQPX-44).

**Conflicts of Interest:** The authors declare no conflict of interest.

## Abbreviations

The following abbreviations are used in this manuscript:

SPM Spherical Parallel Manipulator

MIS Minimally Invasive Surgery

FKM Forward Kinematic Model

IKM Inverse Kinematic Model

DoF Degree of Freedom

CoR Center of Rotation

RRR Revolute-Revolute-Revolute

URU Universal-Revolute-Universal

## References

1. Park, W.; Kim, L.; Cho, H.; Park, S. Design of haptic interface for brickout game. In Proceedings of the HAVE 2009, International Workshop on Haptic Audio visual Environments and Games, Lecco, Italy, 7-8 November 2009; pp. 64-68.

2. Tobergte, A.; Helmer, P.; Hagn, U.; Rouiller, P.; Thielmann, S.; Grange, S.; Albu-Schaffer, A.; Conti, F.; Hirzinger, G. The sigma. 7 haptic interface for MiroSurge: A new bi-manual surgical console. In Proceedings of the 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), San Francisco, CA, USA, 25-30 September, 2011; pp. 3023-3030.

3. van den Bedem, L.; Hendrix, R.; Rosielle, N.; Steinbuch, M.; Nijmeijer, H. Design of a minimally invasive surgical teleoperated master-slave system with haptic feedback. In Proceedings of the ICMA 2009-International Conference on Mechatronics and Automation, Changchun, China, 9-12 August 2009; pp. 60-65.

4. Gosselin, F.; Jouan, T.; Brisset, J.; Andriot, C. Design of a wearable haptic interface for precise finger interactions in large virtual environments. In Proceedings of the First Joint Eurohaptics Conference 2005 and Symposium on Haptic Interfaces for Virtual Environment and Teleoperator Systems, Pisa, Italy, 18-20 March 2005; pp. 202-207.

5. Ma, A.; Payandeh, S. Analysis and Experimentation of a 4-DOF Haptic Device. In Proceedings of the HAPTICS 2008-Symposium on Haptic Interfaces for Virtual Environment and Teleoperator Systems, Reno, NE, USA, 13-14 March 2008; pp. 351-356.

6. Birglen, L.; Gosselin, C.; Pouliot, N.; Monsarrat, B.; Laliberté, T. SHaDe, a new 3-dof haptic device. Robot. Autom. IEEE Trans. 2002, 18, 166-175. [CrossRef]
7. Gosselin, C.; St.Pierre, E.; Gagne, M. On the development of the Agile Eye. Robot. Autom. Mag. IEEE **1996**, *3*, 29–37. [CrossRef]

8. Saafi, H.; Laribi, M.A.; Zeghloul, S.; Arsicault, M. On the development of a new master device used for medical tasks. J. Mech. Robot. **2018**, *10*, 044501. [CrossRef]

9. Saafi, H.; Lamine, H. Comparative Kinematic Analysis and Design Optimization of Redundant and Nonredundant Planar Parallel Manipulators Intended for Haptic Use. Robotica **2020**, *38*, 1463–1477. [CrossRef]

10. Ben Hamida, I.; Laribi, M.A.; Mlika, A.; Romdhane, L.; Zeghloul, S. Dimensional Synthesis and Performance Evaluation of Four Translational Parallel Manipulators. Robotica **2020**, *1–17*. [CrossRef]

11. Damien, C.; Wenger, P. A Comparative Study between Two Three-DOF Parallel Kinematic Machines using Kinetostatic Criteria and Interval Analysis. In Proceedings of the 11th World Congress Mechanism and Machine Science, Tianjin, China, 1–4 April 2003.

12. Brinker, J.; Corves, B.; Takeda, Y. Kinematic performance evaluation of high-speed Delta parallel robots based on motion/force transmission indices. Mech. Mach. Theory **2018**, *125*, 111–125. [CrossRef]

13. Kelaiaia, R.; Company, O.; Zaatri, A. Multiobjective optimization of a linear Delta parallel robot. Mech. Mach. Theory **2012**, *50*, 159–178. [CrossRef]

14. Chablat, D.; Wenger, P. Architecture optimization of a 3-DOF translational parallel mechanism for machining applications, the Orthoglide. IEEE Trans. Robot. Autom. **2003**, *19*, 403–410. [CrossRef]

15. Arsenault, M.; Boudreau, R. The Synthesis of Three-Degree-of-Freedom Planar Parallel Mechanisms with Revolute Joints (3-R RR) for an Optimal Singularity-Free Workspace. J. Robot. Syst. **2004**, *21*, 259–274. [CrossRef]

16. Saafi, H.; Laribi, M.A.; Zeghloul, S. Forward kinematic model improvement of a spherical parallel manipulator using an extra sensor. Mech. Mach. Theory **2015**, *91*, 102–119. [CrossRef]

17. Saafi, H.; Laribi, M.A.; Zeghloul, S. Redundantly actuated 3-RRR spherical parallel manipulator used as a haptic device: Improving dexterity and eliminating singularity. Robotica **2015**, *33*, 1113–1130. [CrossRef]

18. Bai, S.; Hansen, M.R.; Angeles, J. A robust forward-displacement analysis of spherical parallel robots. Mech. Mach. Theory **2009**, *44*, 2204 – 2216. [CrossRef]

19. Bai, S.; Hansen, M.R. Forward kinematics of spherical parallel manipulators with revolute joints. In Proceedings of the AIM 2008—International Conference on Advanced Intelligent Mechatronics, Xi’an, China, 2–5 July 2008; pp. 522–527.

20. Vertechy, R.; Parenti-Castelli, V. Robust, Fast and Accurate Solution of the Direct Position Analysis of Parallel Manipulators by Using Extra-Sensors. In *Parallel Manipulators, Towards New Applications*; Wu, H., Ed.; IntechOpen Limited: London, UK, 2008.

21. Fontanelli, G.A.; Ficuciello, F.; Villani, L.; Siciliano, B. Modelling and identification of the da Vinci research kit robotic arms. In Proceedings of IROS 2017—IEEE/RSJ International Conference on Intelligent Robots and Systems, Vancouver, BC, Canada, 24–28 September 2017; pp. 1464–1469.

22. Saafi, H.; Laribi, M.A.; Zeghloul, S.; Ibrahim, M.Y. Tele-operation control system for non-homothetic master/slave kinematics for minimally-invasive surgery. In Proceedings of the IECON 2013—39th Annual Conference of the IEEE Industrial Electronics Society, Vienna, Austria, 10–13 November 2013; pp. 3800–3805.

<figure><img src="image_21.png" /></figure>

© 2020 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).