1. Introduction
Robotic surgery has been in clinical practice for more than two decades and is steadily expanding, both in the volume of procedures per year and in indications. Even though the market for laparoscopic surgery is dominated by Intuitive Surgical (Sunnyvale, CA, USA) with its da Vinci line of surgical robots, more and more competitors have appeared in the last five years, challenging Intuitive’s prominent position. Competing platforms include the Versius Surgical Robotic System from CMR, the Hinotori Surgical Robot from Medicaroid, Medtronics’s Hugo RAS System, the Revo Surgical Solution from Meerecompany and others. At the same time, research in the field has also been growing [
1], covering various fields such as the introduction of haptic feedback [
2], the use of augmented reality [
3], modeling and evaluation of surgical skill [
4,
5], autonomous surgery [
6], surgical data science [
7], telesurgery [
8] and so on.
A few research platforms have emerged to facilitate academic research and lower the entry barrier for academic teams. These platforms come in the form of customized one-of-a-kind designs or simplified variations of the existing market models. For instance, starting in 2012, Intuitive Surgical introduced the da Vinci research kit (dVRK), which represents a collaborative effort between academia and industry to re-purpose retired first-generation da Vinci systems for research purposes [
9]. Access to the dVRK is selective, and the global community involved in this initiative comprises approximately 40 research centers, with the United States taking a leading role. The underlying code base has been publicly released as open-source. However, several issues have been identified with the platform, namely, reduced precision, inaccurate forward kinematics, link play, inaccurate hand-eye calibration and more [
10]. Another notable project is the RAVEN-II robot [
11], which has been commercialized by Applied Dexterity Inc as a research platform and is also open-source. Its install base counts about twenty sites worldwide. However, no vision system or master controllers are included, which have to be bought separately. Furthermore, its acquisition cost is well over
$150,000, requiring a sizable expenditure to integrate a complete system.
Certain laboratories have opted to develop their own proprietary platforms for research. One such example is the modular and open platform for surgical robotics research (MOPS) robot, created at the University of Southern Denmark [
12]. It utilizes off-the-shelf UR5 and UR5e robotic arms from Universal Robots A/S and incorporates custom adapters to attach Da Vinci’s EndoWrist surgical instruments. Another example is the MiroSurge platform by the German Aerospace Center (DLR), which offers a telesurgical solution that features lightweight bed-mounted manipulators [
13].
All of the aforementioned platforms employ a serial kinematic chain. This design choice provides a substantial workspace for surgical tools and offers straightforward solutions for forward kinematics. However, it often results in non-unique solutions for the inverse kinematics, whereas the servomotors required to drive the base joints are larger due to the need to support the weight of all the links in the forward chain. Furthermore, precision can be compromised due to link flexure and joint play, necessitating bulkier and more rigid links.
Parallel robots emerge as an appealing alternative due to their simpler inverse kinematic solutions, enhanced rigidity, increased speed and accuracy and the ability to support more load weight relative to their own mass [
14]. Their parallel structure also means that errors in the kinematic chain have a reduced impact on the precision of the end effector [
15]. However, they often come with a smaller workspace and more complex forward kinematics. Consequently, some researchers have explored the use of parallel robots in microsurgery contexts [
16], while others have developed platforms tailored for general laparoscopic surgery [
17,
18,
19].
In this research, we introduce an innovative parallel mechanism designed for use as a manipulator in robotic surgery, which builds on the well-established Delta robot as described in [
20]. Our approach involves the parallel connection of two Delta robots with a connecting link that carries the surgical tool, as illustrated in
Figure 1. This configuration results in a robot with five degrees of freedom characterized by simple kinematics.
The resultant robot, aptly named the “Double Delta”, exhibits the capability to execute a pivot motion around a specified point, resembling the laparoscopic motion around the trocar point. This particular point is known as the “remote center of motion” (RCM) and can be dynamically adjusted as needed rather than being fixed in place. Additionally, the deployment of Delta robots as the building block of a more complex mechanism allows us to take advantage of the extensive body of analysis and control already available. Further benefits include low cost, lightweight design and off-the-shelf availability.
The current design is the third iteration of the “Double Delta” concept. In the initial setup, the two Delta robots were arranged on the same plane and linked by a straight connection that held the surgical tool. To enhance its maneuverability, the platform was affixed to a tilting base, enabling it to assume appropriate pitch angles. A comprehensive description of this design, including an analysis of its kinematics and workspace, can be found in [
21].
In the second iteration, the tilting base was abandoned due to its impracticality and the challenges it posed in terms of dynamic control and gravity compensation. Instead, the pitch angle of the tool holder link was adjusted to create a workspace better suited for robotic surgery, enabling the execution of relevant tasks. This modified configuration was employed in a remote telesurgical demonstration over a 5G network [
8]. Although this design proved to be more efficient and was validated in a relevant environment, it came at the cost of a noticeably smaller workspace compared to the initial setup.
In the third and current iteration, the tool is further pitched downward, bringing it to a vertical position. The tool holder link is hinged by a parallelogram mechanism, which is actuated by the two Deltas (
Figure 1). This provides a stronger and stiffer linkage system, while the manipulator exhibits a wider, more symmetric, workspace. Its modelling, analysis and control are presented in the following sections.
2. Materials and Methods
To analyze the Double Delta, we can dissociate the two driving Delta robots with the upper linkage bearing the surgical tool. Thus, with reference to
Figure 1, let
,
be the tool center points of the first and second Deltas. These exhibit three translational degrees of freedom (DOF) each and are controlled by regulating the angles (
,
,
,
,
,
) of their respective motors. Points
and
are considered known in their respective frames
and
of their Delta robots, which, in turn, are rigidly tied to the platform’s
base frame (see
Figure 2 for the definition of the coordinate frames).
The upper linkage mechanism consists of two parallel legs that attach to the tool holder; the first is demarcated by points (, , , ) and the second by points (, , , ). The following list defines the various links and their lengths:
Link defined by ,; length
Link defined by ,; length ;
Link defined by ,; length ;
Link defined by ,; length
Link defined by ,; length H
Link defined by ,; length H
The links and are rigidly attached to the plates of their respective Delta robots, thus having three translational DoFs. They are aligned with the and axes (and, by extension, to the axis of the base frame). Links and are perpendicular to and and rotate about and with an angle . They attach to link and the tool holder link . These form the parallelogram mechanism (,,,, which keeps the links and parallel. The length of the horizontal links of the mechanism (-,-) is S, while for the vertical ones (-,-) it is H.
The tool holder link is hinged at points and and rotates about the two axes that pass through them. Since is a side of the parallelogram mechanism, we can characterize the rotation of all axes (and orientation of all links) of the mechanism using a single frame. We define such a frame on , called the tool holder frame , with its axis being the axis of rotation of through .
The tool holder bears a driving mechanism that controls an Endowrist surgical tool using four HerkuleX DRS-0201 servos. At its tip lies the tool point
and the
tool frame , which is rigidly attached to the tool holder. Apparently, frames
and
are parallel, differing by a fixed translational and rotational component. The transformation between
and
, with reference to
Figure 1, is given by
Vector
expresses the displacement of
in the tool holder frame and is constant. Since the two Delta robots are rigidly attached to the platform’s base, the transformation from each Delta’s base frame
to the platform’s base frame
, is constant and defined as
where
is the rotation matrix about the
Z axis and
; hence, the base frame is midways between the two Deltas.
The mapping from the base frame to frames
and
is straightforward since they have the same orientation but differ in the translational component; that is,
where
are the tool center points of the two Deltas in the platform’s base frame. To calculate the mapping from
to
respectively, we first note that the rotation about axes
is the same and denoted as
. This can be easily inferred by observing that links
are fixed on the tool holder link and rotate along with it. Essentially, the axes
must always be on the same plane as the mechanism and thus must always be parallel. The transformations are hence given by
Matrix
is the chained rotation about the axes
and
Z, while the vectors
and
. For the rotation of the tool holder frame
about
, we note that its axis of rotation coincides with the joint axes of the parallelogram mechanism, and thus its angle of rotation is
. The transformations from
to
and
are given by
where
,
and
are constant displacement vectors in their respective frames. Vector
can be expressed in frame
as
.
In the following, to simplify the notation, all quantities without a left superscript will refer to the base frame unless explicitly given in a different frame, in which case, the appropriate superscript will be noted. The same also holds in case of ambiguities about the frames in which the variables are expressed.
2.1. Forward Kinematics
Formally, forward kinematics refers to computing the position and orientation of the robot’s end effector, i.e., frame
, given the joint angles (
,
,
,
,
,
) of the two deltas. However, we consider the points
,
known in
, obtained by the forward and inverse kinematic solutions of the Deltas, as described in [
20]. Thus, the analysis of the platform can focus on the upper linkage mechanism. Using the link transformations described in the previous section, the map from the tool frame to the base frame is given by (see
Appendix A for the proof)
where
is the
orientation matrix of the tool in the base frame. This can be further simplified by using the following identity regarding rotation matrices and an axis of rotation:
Proposition 1. Given a rotation about axis by an angle ϕ, denoted by matrix , and an orthogonal matrix that transforms the rotation axis, the following relation holds: Using this relation, we can change the rotation about the
x-axis to the
y-axis viz.
Plugging into Equation (
8), we obtain
and dropping the argument notation, we finally arrive at the following equation:
Analyzing Equation (
15), we observe that in the base frame, it consists of a
pitch rotation about
and a
roll rotation about
. In the rest position, i.e.,
, the tool frame is pitched downward by
in
. The actual orientation angles of the tool in the base frame are given by
Substituting
in Equation (
15) and expanding, the orientation matrix of the tool is found to be
where, as usual,
and
.
In
the rotation matrix is decomposed into a
pitch rotation about
, followed by a
yaw rotation about
. This means that the surgical tool cannot rotate about its axis, which can be easily understood by noting that links
act on the axis
without an arm and, therefore, cannot produce a moment about that axis. To simplify the analysis, we model the platform abstractly using
Figure 3.
Using homogeneous coordinates, we express all vectors in the base frame. Slightly abusing notation, the simple calculations show
Adding (
20), (
22) and (
23), we obtain
Furthermore, by observing
Figure 3, we can traverse the two legs and define the following two vectors:
Note that vectors
are all constants when expressed in the base frame, viz,
This means that the motion of the points
directly mirrors that of
. Thus kinematically, we can consider that the two Deltas are attached to
. As is shown in the following, this observation is very helpful for efficiently calculating the inverse kinematics of the platform. Substituting Equations (
26) and (
24) into Equation (
7), the transformation from the base frame to the tip can be written as
The
tool point in the base frame can thus be written as
Note that both the rotation matrix
and the tool point
depend on the angles
and
. Thus, they must be solved with respect to the input variables
. To this end, by observing
Figure 3 we see that the vector
is identical to
. In its local frame
,
is constant. However, when expressed in the base frame, it is equal to
. We then have the following equation:
Expanding the rotation matrices and performing calculations, we obtain
and solving for
,
For a pitch angle of or there is a kinematic singularity that leads to an undefined yaw angle (i.e., ). In this configuration, the links and coincide, which is mechanically impossible. We have thus constrained the pitch angle to .
2.2. Inverse Kinematics
For the inverse kinematics, we consider the tool point
and the orientation angles
, known in the base frame. Then, we must calculate the points
. Trivially, using Equation (
18), we compute the orientation matrix
, and combining Equations (
30) and (
26), we solve for
, viz.
Similarly, using Equation (
31) and solving for
,
The computed center points, denoted as
and
, for the two Deltas may not necessarily indicate valid solutions, as they could lie outside their workspace. Consequently, valid values for
are confined within their respective Delta workspaces, necessitating an inclusion test to verify the specific inverse kinematic solution. The Delta robot’s workspace, illustrated in
Figure 4A, can be approximated by an inscribed cone with height
h and radius
r. This simplified geometric approximation streamlines the inclusion test, significantly reducing computational overhead and making it suitable for real-time control.
In pursuit of this objective, consider the workspace frame
corresponding to the Delta robot “
i”, as depicted in
Figure 4B. Positioned at the cone’s vertex, this frame has its
Z-axis directed toward the base. The alignment of frame
with the Delta’s base frame
is established through a known transformation denoted
. Consequently, the transformation of points
,
is carried out within
as follows:
Now, define the following coordinates in
:
where
. Upon examination of
Figure 4B, it is evident that given the apex angle of the cone is
, the inclusion constraints for
in the cone are as follows:
2.3. Forward Velocity Kinematics
To calculate the forward velocity kinematics, we consider that the points
are known in
and have respective known velocities
. Furthermore, the orientation angles
of the tool are also given in the base frame, derived from the forward position kinematics. The goal is to compute the linear velocity
of the tool point and the angular velocities
of the tool frame
in the base frame. Starting from the latter, using Equation (
18), the orientation matrix
can be found. The angular velocity tensor
can be calculated directly by the known equation:
Performing the calculation (see
Appendix C for the proof), we arrive at the following formula:
and collecting terms, we can write the angular velocity vector as
For the passive joint angle velocities, differentiating Equations (
32) and (
33), we obtain (see
Appendix B)
where
. Combining (
43) and (
42), the angular velocity can finally be written as
Note that the rank of
is 2, thus
has two independent degrees of freedom. This is due to the fact that the roll of the robot, in the
tool frame, is always zero and, hence, has two rotational DoFs. Consequently, the angular velocity can be described by only two components in a proper frame. To calculate the linear velocity of the tool point, we differentiate (
30) with respect to time, viz.
Expanding the second term on the right-hand side, we obtain (see
Appendix D for the proof)
where
Combining (
44) and (
46), we derive the following
decoupled velocity equations:
We observe that the angular velocity is decoupled from the first input
and depends solely on the relative velocity of the two Deltas. If we denote the actuated joint vector as
, the generalized velocity is
and the end-effector velocity is
. We can derive the geometric Jacobian from (
48) as follows:
The matrix is called the direct kinematic Jacobian and is evidently singular, which is expected since the robot exhibits five DoFs, while the input is 6D.
2.4. Inverse Velocity Kinematics
For the inverse velocity kinematics, we consider that the linear and angular velocities
and
of the tool are given, and we seek to calculate the velocities of the actuating joints, i.e.,
. Again, the positional configuration of the robot is completely known. Consequently, solving for
from (
45), we have
and combining (
58) and (
50),
is
To calculate the inverse kinematic Jacobian, we note that (
50) and (
51) can be written in vector form as
where
is a skew-symmetric matrix of A associated with the cross product. Factoring (
52), we come up with the following:
Equivalently, the inverse velocity equations are
2.5. Constraints and Forces
Since the two legs act on the same link
, by traversing them we can denote the following
loop closure equation:
It can be readily observed that (
55) expresses a
geometric constraint of the system that involves the two Delta tool points
, or equivalently,
. Under the assumption that the links are totally rigid, by squaring (
55), we obtain
hence, their distance is always constant and equal to the link length. Equivalently, we can use the second equation of (
55) and arrive at the following formula:
Equation (
57) indicates that
is situated on a sphere with a radius of
H and centered at
. Consequently, all solutions to the kinematics equations must adhere to this restriction. This introduces an additional layer of complexity in the context of forward kinematics. To address the problem, we initially assumed that
and
are given. However, it becomes apparent that this assumption is insufficient; generally, a pair of
and
does not guarantee valid kinematic configurations for the platform. These values must also satisfy the geometric constraint described in Equation (
57).
By differentiating (
57), we can arrive at a
kinematic constraint involving the two velocities
, viz.
Multiplying from the left with
and considering that the quadratic form of
is always zero since it is skew-symmetric, we have
and expanding
The equation implies that the projections of the velocities of the two joints onto the tool link should be equal. Equivalently, the relative linear velocity
of the two actuating joints should be perpendicular to the tool link
. This means that
should always reside in the orthogonal complement of
, i.e., its orthogonal plane. We observe that
is parallel to the
x-axis of the tool frame
. Since its orientation is the matrix
in (
18), the vectors spanning this plane are the second and third columns of the matrix. Thus,
should be of the form
where
is the
constrained relative velocity vector. Substituting
in (
44) and (
45), the new
constrained matrices are
and the constrained forward decoupled velocity equations are
We note that the (constrained) velocity vector is .
Using the inverse kinematic Jacobian, we can write the familiar force/torque transmission equation for the robot, which holds true both for serial and parallel kinematics, viz.
where
is the wrench transmitted to the end effector through the forces
applied by the two Deltas on
. Although the mapping from the Delta forces to the end effector is unique, the singularity of
implies that the inverse is not true; there is an infinite range of solutions that map the end effector wrench onto the two Delta forces. These contain components that lie in the null space
and do not contribute to the motion of the platform; they represent internal
antagonistic forces. These can be investigated by setting (
64) to null and solving for
, viz.
This leads to the following conditions:
Thus, the forces in the null space must be opposite, sum to zero and must lie in the space spanned by . Obviously, the null space is .
2.6. Gravity Compensation
In order to implement a control algorithm for the platform, an initial step involves offsetting the influence of gravity. This results in the robot being perceived by the controller as “weightless”. For this purpose, we assume that the robot moves at a sufficiently slow pace, minimizing any inertia effects, which are consequently disregarded. The algorithm for
gravity compensation entails determining the necessary forces to be exerted by each Delta robot, ensuring that the platform attains static equilibrium at every pose. To this end, we employ the
direct Lagrangian Method to compute the forces [
22]. According to this, when the robot is in static equilibrium, the kinetic energy is null and the Lagrangian involves only the contribution of the potential energy U of the system. Then, the equations of motion, using the Euler–Lagrange formulation, transform to
where
is the generalized coordinates of the system and
the generalized forces. In the specific case of our redundantly actuated parallel robot, we compute only the derivatives with respect to the actuated joints. Consequently, the compensation forces are given by
To calculate the potential energy of the system, we consider each link separately. The center of mass
of link
i, where
i = 1, 2, 3, 4, 5, H is given in the respective frame
by the displacement vector
(
Figure 5). Casting them into the base frame
, the potential energies are given by
with
being the gravity vector. Note that the frame in link 5 is parallel to the tool holder frame but shifted to
. By performing the calculations, we arrive at the following formulas:
where U is the potential energy of the robot,
and
. Taking the partial derivative of U with respect to to each actuated joint, we have
We also note that
for
. Combining (
78), (
77) and (
71), we arrive at the following:
where
Expanding the partial derivatives of
and
,
is found to be
For the derivatives of
with respect to
, using a similar reasoning as in Equations (
A8) and (
A11), we can write the following:
Substituting
from (
57) and performing calculations,
and
Putting it all together, (
84), (
83) and (
81) transform (
79) into
Restructuring the equations, we can write the gravity compensation forces in the following form:
We observe that the two forces consist of an opposite component plus a vertical force specific to the mass of the links supported by each one.
2.7. Remote Centre of Motion
The point in a mechanism that remains fixed under rotation is known as the center of motion (CM). When the CM is not located on the mechanism itself, it is called a
remote center of motion (RCM). Robots equipped with RCM are particularly valuable in laparoscopic surgery, as they can adapt to procedural kinematics. Typically, surgeons make small incisions in the abdominal wall through which cannulas (trocars) are inserted, providing access to the inner site. The laparoscopic instruments are then introduced through the trocars and execute a pivoting motion around this
fulcrum point (
Figure 6), confined within a cone with its vertex at said point. From a kinematic point of view, the entry point serves as the RCM of the robotic manipulator.
Although most surgical robots available have a statically/mechanically fixed RCM, the Double Delta robot can dynamically emulate motion through a user-specified RCM. In other words, the RCM can be altered programmatically to suit the user’s requirements.
By imposing an RCM, the range of motion of the laparoscopic tool is limited to
yaw and
pitch about the insertion axis, along with a linear
in–out motion. Consequently, the degrees of freedom of the robot are reduced to
three. Let
denote the RCM of the manipulator in the base frame. The tool’s axis must always intersect with
. If the tooltip point
is known, then the vector
lies on this axis and is parallel to vector
. Hence, we can calculate
as follows:
and utilizing (
33), we can compute the orientation matrix
of the platform, consequently solving the inverse kinematics.
2.8. Workspace Analysis
In this section, we delve into an analysis of the platform’s workspace, considering the robot’s capability to navigate specific points under various orientations with its five degrees of freedom. We determine this reachable workspace by utilizing a sampling-based method involving inverse kinematics.
Initially, we create a 3D regular grid, sampling the space around the tooltip while the platform is at rest. Subsequently, we systematically sample yaw and pitch angles to generate all possible orientations for the tool. Points
and
on the holder trace two concentric spheres centered at
. By moving these spheres to each grid point
, we produce a set of candidate poses for the tool. Each pose is then examined to determine whether it is a valid configuration of the platform. Here we can discern two methods; the first is to use the analytical inverse kinematics of each Delta to produce the
full reachable workspace
, or we can utilize the conical approximation for the Deltas’ workspaces, as presented in
Section 2.4, resulting in the
approximate reachable workspace
.
The
full workspace is the true attainable range of motions the robot can acquire, but the
approximate workspace is used in the actual analysis and control of the robot and is the one used in the programmatic implementation due to its fast cone inclusion tests. In addition to these two workspaces, when the RCM constraint is applied, the degrees of freedom of the platform drop to “three” and the reachable workspace is contracted. This leads to the
RCM workspace
, which is evidently a subset of the
approximate workspace. Since the RCM is parametrizable and can thus change,
is a family of workspaces, dependent on the actual position of the remote center of motion. The
maximal (in terms of volume) RCM workspace is presented in
Figure 7, along with the
full and the
approximate reachable workspaces.
In particular, we observe that the
full workspace is not symmetric about the
xz-plane, as is the case with the other two workspaces, due to the two Deltas being mounted facing different directions (frames
are rotated by
and
about the
axis—see
Figure 2). To produce the previous workspaces, the following robot parameters were used (
Table 1):
To measure the workspaces, we determine their volume by employing an alpha shape reconstruction. This involves utilizing the critical
alpha radius that generates a closed, non-convex three-dimensional solid encompassing
all the points within the workspace [
23]. In the following table, we present the volume of each workspace as computed by the alpha shape, the step used for creating the sampling grid and the dimensions of its bounding box, viz.
Table 2 reveals that the conical approximation of each Delta’s workspace is approximately half of its actual workspace (1.90 vs. 3.78 lt). However, this results in a workspace for the Double Delta that is roughly 30% less than its full range (87.58 vs. 126.39 lt). We can accept this underutilization of the workspace as a deliberate compromise for the swift conical inclusion test in the inverse kinematics solution, along with providing a safety buffer for the robot to prevent links from extending to the boundaries.
We emphasize that the RCM workspace presented in
Table 2 pertains to the maximal workspace. To determine this, we conducted a systematic search, correlating the RCM point’s position with its resulting Double Delta workspace. This involved sampling the space surrounding the tool using a regular grid, here with a step of 10 mm, generating a set of candidate RCM points. For each point, we computed the valid robot poses where the tooltip
is within
. This process yielded a collection of RCM voxels, each associated with a specific workspace volume. A visual representation of this grid, color-coded according to the volume of the corresponding workspace, is presented in
Figure 8.
Notice that the maximum workspace volume associated with the RCM voxels is approximately 58 lt, whereas the value presented in
Table 2 is recorded as 55.22 lt. This discrepancy arises from our approach to accelerate calculations and ensure the tractability of the search process. Instead of directly calculating the volume of the alpha shape for the workspace of a given RCM point, we opted for a more efficient method. We collected the number of valid points, and by multiplying this count with the voxel volume of the workspace grid, we estimated the volume corresponding to each point’s workspace. This method yields a slightly higher estimate, approximately 5% more, compared to the direct calculation of the alpha shape.
To gain a more profound insight into the stratification of the RCM voxels, we performed an analysis by computing the cumulative histogram of RCM voxels based on their corresponding workspace volumes. This plot provides a comprehensive view of the volume distribution, showing the volume of RCM voxels that have
at least a given workspace volume. Essentially, it offers a nuanced understanding of how the workspace volumes are distributed across the RCM voxels. As depicted in
Figure 9, the plot illustrates that the volume of RCM voxels with a minimum reachable workspace of 10 lt is approximately 8 lt. This volume decreases to 2 lt for a 40 lt reachable workspace and continues this trend for other values. Notably, a substantial portion of the plot demonstrates linear behavior. Given that the plot is presented on a semi-logarithmic axis, we can infer that the distribution of RCM voxels follows an exponential decay pattern with respect to the workspace volume.
The workspace needed for laparoscopic surgery depends on the procedure. For example, an analysis in robotic-assisted cholecystectomy estimated an overall workspace of about 0.7 lt in the shape of an ellipsoid [
24]. In general, the available volume can vary according to the achieved intra-abdominal pressure to sustain a pneumoperitoneum, abdominal compliance, patient body mass index surgical position and the actual surgical field [
25]. The normal workspace during laparoscopy ranges from 3 to 6 lt [
26]. According to the distribution in
Figure 9, this range is covered by 12 to 21 lt of RCM voxels.
2.9. Simulation and Control
To test the previous analysis and develop control algorithms, the system was modeled in Matlab’s Simscape Multibody, which provides a multi-body physics simulation environment for 3D mechanical systems. The platform was initially designed in a commercial CAD/CAM software package (DS Solidworks) and then ported to Simscape (
Figure 10). However, its complexity was reduced by considering internal components (gear, etc.) as solid objects rigidly attached to their place. The motion transmission elements were modeled by replacing the rotary joints
with the respective components in Simscape. The inertia matrix for each link was determined and inserted into the simulation. Note that only the linkage system was modeled. The two driving Delta robots were abstracted as two Cartesian joints located at points
. The input of the system was the two forces
of these two actuators.
The control objective was to track a reference point for the tooltip
point under an RCM constraint, i.e., a teleoperation task. To this end, we developed a PID+G controller that regulates the forces
. The gravity term “G”, as computed by (
86), is a feed-forward signal accounting for gravity compensation. This is superimposed with the feedback loop signal from the PID controllers. The two forces are regulated by two different control loops. However, the control gains are the same for both controllers. Furthermore, even though the forces are 3D vectors and the controllers are thus MIMO, they contain only diagonal elements i.e., the cross-coupling input–output terms are set to
null. The control equation is given by
where
is the error between the points
and the reference positions
of these points computed by inverse kinematics, given the reference position
of the tooltip. The derivative term “
D” is implemented as a low-pass filter with a cut-off frequency N = 20 Hz. The PID output was also limited by a saturation block to prevent excessive signals from driving the motors. A schematic of the control diagram is presented in
Figure 11.
3. Results
The PID controllers were manually tuned with gains set to = 30,000, = 5000 and = 1000. To assess their performance, two tests were conducted. In the first test, a dynamic tracking task was executed in which the objective was to follow a circular reference trajectory with a tooltip. This trajectory, formed by a point moving along the circle at a frequency of 0.33 Hz, was located on the plane with a radius of 50 mm.
For the second task, the reference signal was derived from an actual experiment using the da Vinci surgical robot. Specifically, we extracted kinematic data from the left patient side manipulator during a suturing trial from the JIGSAWS dataset [
27]. The data were then used as input to the controller for tracking.
The results of the first experiment are shown in
Figure 12.
The aggregate data for both tracking experiments are given in
Table 3. We see that both the
rms error and the maximum tracking error of the tooltip point
are well below 1 mm, similarly for the upper and lower errors on each dimension
X-Y-Z separately.
As a further step to investigate the performance and stability of the controlled system, we performed a nonlinear Bode analysis, following the related concept as presented by Pavlov et al. in [
28]. Assuming that the closed-loop system is
convergent, i.e., it has a unique, globally asymptotically stable solution called the steady-state solution, by applying a harmonic excitation with varying frequencies
and amplitudes
, the system admits a unique periodic solution
. We note that this solution need not be harmonic and depends both on the frequency and on the amplitude. If we denote its maximum absolute value at
by
, then the ratio
can be regarded as an amplification gain. Taking the maximum gain over a range of amplitudes
, we can consider
,
. Plotting
over
, we can visualize the non-linear Bode plot for the closed-loop system. This expresses the maximum amplification gain per frequency. For our system at hand, we performed this procedure by providing harmonic excitations at each input separately (
X-Y-Z) in a frequency range of 0.5 to 30 Hz. The amplitudes ranged from 25 mm to 125 mm. By computing the amplification gain, we obtain the diagram seen in
Figure 13. Since our system is MIMO, we also include the cross-coupling terms, i.e., X-Y, X-Z, Y-X, Y-Z, Z-X and Z-Y.
We notice that the amplification in the diagonal gains is relatively small, up to approximately 8–9 Hz. However, at higher frequencies, the system demonstrates considerable damping. The cross-coupling terms similarly display notable attenuation at lower frequencies, although this diminishes as the frequency increases. However, even in the most extreme case, it remains below −10 dB. This suggests a substantial level of decoupling between the inputs and outputs.
It is worth mentioning that when examining the frequency spectrum of the suturing trials in the JIGSAWS dataset, over 99% of the signals’ power is concentrated below 1 Hz. In this light, the Bode diagram underscores the system’s propensity to follow the low-frequency activity of actual surgical maneuvers.
4. Discussion
Compared to other research platforms, the Double Delta seems to present better tracking performance. For example, the mean tracking error for the MOPS robot is reported to be between 1.2 mm to 2.7 mm [
12]. Similarly, tracking tests using a cascade controller for the Raven II platform present a mean translational error of 1.55 mm [
29]. We note, however, that since the Raven II robot is cable driven, the estimation of its pose, which was used in the controller, is particularly difficult as it is affected by elasticity, friction and tensioning of the cables. The estimation error of its end-effector is in the range of 10 to 25 mm [
29], which is an order of magnitude larger than the tracking error of the controller. Efforts to reduce this uncertainty are also reported in the literature using vision-based neural networks [
30]. However, this setup increases the complexity of the system, adding overhead and cost.
Similar problems are met with the da Vinci research kit. The dVRK is also cable driven, something that impacts its kinematic estimation accuracy. The tool tip estimation error is reported to be up to 1.02 mm [
10], whereas trajectory tracking experiments report a mean error of 2.05 mm [
31]. The Double Delta bypasses the problems exhibited with cable-driven actuation by using rigid links connected with revolute joints directly driven by the servomotors. Since the links are connected in parallel, the mechanism presents better rigidity than a single serial link. This also allows the use of thinner links, hence, reducing the overall weight. Furthermore, the parallel structure of the Double Delta enables it to exert more force per weight, leading to less bulky motors and links and, ultimately, to a more compact size.