Next Article in Journal
Deep Learning-Based Object Classification and Position Estimation Pipeline for Potential Use in Robotized Pick-and-Place Operations
Next Article in Special Issue
Displacement Analysis and Design of a (2–RRU)–URR Parallel Mechanism Performing 2R1T Output Motion for Thumb Rehabilitation
Previous Article in Journal
Globally Optimal Inverse Kinematics Method for a Redundant Robot Manipulator with Linear and Nonlinear Constraints
Previous Article in Special Issue
Synthesis and Analysis of a Novel Linkage Mechanism with the Helical Motion of the End-Effector
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

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

1
Mechanical Laboratory of Sousse (LMS), National Engineering School of Sousse, University of Sousse, Sousse 4000, Tunisia
2
Preparatory Institute for Engineering Studies of Gafsa, University of Gafsa, Gafsa 2000, Tunisia
3
Department of GMSC, Prime Institute, CNRS—University of Poitiers, ENSMA—UPR 3346, 86073 Poitiers, France
*
Author to whom correspondence should be addressed.
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.
Robotics 2020, 9(3), 62; https://doi.org/10.3390/robotics9030062
Submission received: 25 June 2020 / Revised: 2 August 2020 / Accepted: 3 August 2020 / Published: 6 August 2020
(This article belongs to the Special Issue Theory and Practice on Robotics and Mechatronics)

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.

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 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. Mores studies [11,12,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.
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.
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.
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 hold 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.

3. Kinematic of the Modified Spherical Parallel Manipulator

The kinematic model of the spherical parallel manipulator is as follow:
A · ω = B · θ ˙
where, ω is the angular velocity of the moving-platform, θ ˙ 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 × B
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 ψ , θ and φ . 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 α and the second link is defined by the angle β . Moreover, the angle γ is the angle between Z 3 k ( 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.
The kinematic model of the haptic device can be written as follows. For the leg B and C, we can write:
Z 2 k · Z 3 k = β w i t h , ( k = B , C )
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 2 k and Z 3 k is β .
By differentiating the Equation (3), we get:
Z ˙ 2 k · Z 3 k + Z 2 k · Z ˙ 3 k = 0
with,
Z ˙ 2 k = θ ˙ 1 k Z 1 k × Z 2 k ; Z ˙ 3 k = ω × Z 3 k
with, ω is the angular velocity of the moving platform. The kinematic model of leg B and C is as follows:
θ ˙ 1 k Z 1 k × Z 2 k · Z 3 k = ω · Z 2 k × Z 3 k
For the leg A with the new architecture, we have:
ω = θ ˙ 1 k Z 1 k + θ ˙ 2 k Z 2 k + θ ˙ 3 k Z 3 k + θ ˙ 4 k Z 4 k + θ ˙ 5 k Z 5 k
To get a relation between ω and the active angle θ 1 A , Equation (7) is multiplied by the vector V r orthogonal to Z 2 A , Z 3 A , Z 4 A and Z 5 A . We obtain:
V r · ω = θ ˙ 1 A V r · Z 1 A
with,
V r = Z 4 A × Z 5 A
The matrices A and B are as follows:
A = ( Z 5 A × Z 4 A ) T ( Z 3 B × Z 2 B ) T ( Z 3 C × Z 2 C ) T
B = ( Z 5 A × Z 4 A ) · Z 1 A 0 0 0 ( Z 3 B × Z 2 B ) · Z 1 B 0 0 0 ( Z 3 C × Z 2 C ) · Z 1 C
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:
η ( J ) = 1 κ ( J )
where κ ( J ) is the condition number of the Jacobian matrix. It has the following expression:
κ ( J ) = J · J 1
The dexterity distributions for φ = 50 , φ = 0 and φ = 50 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.

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 ( θ 1 A , θ 1 B , θ 1 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 3 B and Z 3 C axes), the second link of the legs C and finally, a fictive link between the joints with axis Z 2 B and the axis Z 2 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 ( ξ ) c o s σ + M 1 ( ξ ) s i n σ + N 1 ( ξ ) = 0
where L 1 , M 1 and N 1 are functions of c o s ξ and s i n ξ .
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 5 A and Y 1 A as follows:
Z 5 A · Y 1 A = 0
with,
Z 5 A = R 0 B R Z ( θ 1 B ) R X ( α ) R Z ( ξ + ξ ) R X ( β ) R Z ( σ μ ) R X ( γ ) R Z ( 2 π / 3 ) R X ( γ ) Z Y 1 A = R Z ( θ 1 A ) Y
Z 5 A is orthogonal to Y 1 A because Z 5 A is in the plan formed by Z 1 A and X 1 A (see Figure 6b).
After arrangement, we get the following expression:
L 2 ( ξ ) c o s σ + M 2 ( ξ ) s i n σ + N 2 ( ξ ) = 0
where L 2 , M 2 and N 2 are functions of c o s ξ and s i n ξ . The expressions of c o s σ and s i n σ are computed using Equations (14) and (17) as follows:
c o s σ = M 1 N 2 M 2 N 1 L 1 M 2 L 2 M 1 ; s i n σ = L 1 N 2 L 2 N 1 L 1 M 2 L 2 M 1
The equation with ξ as unknown can be obtained through a square sum of c o s σ and s i n σ :
N 2 2 L 2 2 + 2 L 1 M 1 L 2 M 2 2 L 1 N 1 L 2 N 2 + N 2 2 M 1 2 L 2 2 M 1 2 2 M 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
Equation (19) allows to compute all solutions of ξ after a rewritten to 8th degree polynomial transformation using the tan-half identities technique, x = t a n ( ξ / 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 σ .
To determine the orientation of the end-effector, the direct serial model of leg B is used. Since, the angle θ 1 B is directly given by the sensor and the angles θ 2 B and θ 3 B may be calculated using the angles, ξ , and, σ , ( θ 2 B = ξ + ξ and θ 3 B = σ μ ).
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 ( σ and ξ ) are required to solve the forward kinematic of this parallel manipulator (see Figure 8). Here, a forth sensor is included to the control system and installed on the axis Z 3 B . The values of angle σ became known in Equations (14) and (17). The FKM has one unknown variable, the angle ξ , and the problem can be reformulated as follows:
L ¯ 1 c o s ξ + M ¯ 1 s i n ξ + N ¯ 1 = 0 L ¯ 2 c o s ξ + M ¯ 2 s i n ξ + N ¯ 2 = 0
where L ¯ i , M ¯ i and N ¯ i ( i = 1 , 2 ) are variables that depend on c o s σ and s i n σ and obtained by arranging Equations (14) and (17).
The angle ξ is given by the following expression:
ξ = a t a n 2 ( s i n ξ , c o s ξ )
with,
c o s ξ = M ¯ 1 N ¯ 2 M ¯ 2 N ¯ 1 L ¯ 1 M ¯ 2 L ¯ 2 M ¯ 1 , s i n ξ = L ¯ 1 N ¯ 2 L ¯ 2 N ¯ 1 L ¯ 1 M ¯ 2 L ¯ 2 M ¯ 1
This method gives a direct and unique solution to the FKM. However, the expression of L ¯ 2 , M ¯ 2 and N ¯ 2 are very complex. In fact, L ¯ 2 , for instance, contains 219 c o s or s i n 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 platfom. Figure 9 presents one leg of the SPM equipped with three sensors.
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 0 B R Z ( θ 1 B ) R X ( α ) R Z ( θ 2 B ) R X ( β ) R Z ( θ 3 B ) R X ( γ ) R Z ( 2 π 3 )
The previous methods use the serial approach to determine the orientation of the end-effector. However, the angles θ 2 B and θ 3 B are calculated using the angles ξ and σ . For the case of the serial approach, θ 2 B and θ 3 B 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.
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 φ should be equal to zero. The joint with axis Z 5 A 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.
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.
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.

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.
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.
The duration of the suturing experiments at first experimentation is greater than one of the classic operations (manual procedure without the use of tele-opreation 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.

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:
SPMSpherical Parallel Manipulator
MISMinimally Invasive Surgery
FKMForward Kinematic Model
IKMInverse Kinematic Model
DoFDegree of Freedom
CoRCenter of Rotation
RRRRevolute-Revolute-Revolute
URUUniversal-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. [Google Scholar]
  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. [Google Scholar]
  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. [Google Scholar]
  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. [Google Scholar]
  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. [Google Scholar]
  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. [Google Scholar] [CrossRef] [Green Version]
  7. Gosselin, C.; St.Pierre, E.; Gagne, M. On the development of the Agile Eye. Robot. Autom. Mag. IEEE 1996, 3, 29–37. [Google Scholar] [CrossRef] [Green Version]
  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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar]
  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. [Google Scholar] [CrossRef]
  13. Kelaiaia, R.; Company, O.; Zaatri, A. Multiobjective optimization of a linear Delta parallel robot. Mech. Mach. Theory 2012, 50, 159–178. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar] [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. [Google Scholar]
  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. [Google Scholar]
  21. Fontanelli, G.A.; Ficuciello, F.; Villani, L.; Siciliano, B. Modelling and identification of the da Vinci research kit robotic arms. In Proceedings of the IROS 2017—IEEE/RSJ International Conference on Intelligent Robots and Systems, Vancouver, BC, Canada, 24–28 September 2017; pp. 1464–1469. [Google Scholar]
  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. [Google Scholar]
Figure 1. Haptics devices: (a) First Prototype, (b) Second prototype.
Figure 1. Haptics devices: (a) First Prototype, (b) Second prototype.
Robotics 09 00062 g001
Figure 2. MIS possible movement.
Figure 2. MIS possible movement.
Robotics 09 00062 g002
Figure 3. Tele-operation system synoptic.
Figure 3. Tele-operation system synoptic.
Robotics 09 00062 g003
Figure 4. Pprime Robot for Minimally Invasive Surgery: (a) Developed Master Station, (b) Developed Slave Station.
Figure 4. Pprime Robot for Minimally Invasive Surgery: (a) Developed Master Station, (b) Developed Slave Station.
Robotics 09 00062 g004
Figure 5. Architecture of the special Spherical parallel manipulator.
Figure 5. Architecture of the special Spherical parallel manipulator.
Robotics 09 00062 g005
Figure 6. Geometric parameters: (a) RRR leg, (b) URU leg.
Figure 6. Geometric parameters: (a) RRR leg, (b) URU leg.
Robotics 09 00062 g006
Figure 7. Dexterity distributions for three values of φ .
Figure 7. Dexterity distributions for three values of φ .
Robotics 09 00062 g007
Figure 8. Spherical four-bar mechanism (one closed loop).
Figure 8. Spherical four-bar mechanism (one closed loop).
Robotics 09 00062 g008
Figure 9. Leg B with three sensors.
Figure 9. Leg B with three sensors.
Robotics 09 00062 g009
Figure 10. Orientation of the moving platform.
Figure 10. Orientation of the moving platform.
Robotics 09 00062 g010
Figure 11. Error Distributions for the tree models.
Figure 11. Error Distributions for the tree models.
Robotics 09 00062 g011
Figure 12. Motion control scheme.
Figure 12. Motion control scheme.
Robotics 09 00062 g012
Figure 13. Hollow model of an artery.
Figure 13. Hollow model of an artery.
Robotics 09 00062 g013
Figure 14. Anastomosis phases.
Figure 14. Anastomosis phases.
Robotics 09 00062 g014
Figure 15. An experiment being carried out by the surgeon.
Figure 15. An experiment being carried out by the surgeon.
Robotics 09 00062 g015
Figure 16. Sutures performed using the teleoperation system.
Figure 16. Sutures performed using the teleoperation system.
Robotics 09 00062 g016
Table 1. Calculation time of the three methods.
Table 1. Calculation time of the three methods.
FKM ModelCalculation TimeSensor
Classic≈90  μ s3 sensors in the base
Improved≈60  μ s4 sensors
Serial≈15  μ s3 sensors in the leg B
Table 2. Parameters of the distribution of each model.
Table 2. Parameters of the distribution of each model.
FKM ModelMean ValueStandard Deviation
Classic 0 . 182 0 . 193
Improved 0 . 178 0 . 196
Serial 0 . 276 0 . 229

Share and Cite

MDPI and ACS Style

Saafi, H.; Laribi, M.A.; Zeghloul, S. Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation. Robotics 2020, 9, 62. https://doi.org/10.3390/robotics9030062

AMA Style

Saafi H, Laribi MA, Zeghloul S. Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation. Robotics. 2020; 9(3):62. https://doi.org/10.3390/robotics9030062

Chicago/Turabian Style

Saafi, Houssem, Med Amine Laribi, and Said Zeghloul. 2020. "Forward Kinematic Model Resolution of a Special Spherical Parallel Manipulator: Comparison and Real-Time Validation" Robotics 9, no. 3: 62. https://doi.org/10.3390/robotics9030062

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop