Professional Documents
Culture Documents
Mechatronics
journal homepage: www.elsevier.com/locate/mechatronics
Keywords: Magnetically-actuated flexible surgical robot has promising applications for ultra-narrow and tortuous orifices,
Soft robotics however, how to minimize the energy consumption, physical interaction between the external electromagnet
Magnetic actuation (EEM) and the human body, and the bulky size of the magnetic actuation system remains a major challenge.
Steerable catheters/needles
This work presents a hybrid force-magnetic control scheme that can magnetically steer catheters with the
Force control
least distance in order to reduce energy consumption and the size of the magnet. In addition, the use of
force feedback control allows the motion of magnet adapts to the movement of patient’s body, ensuring safety
during the operation. The scheme is composed of two parts: a Jacobian-based inverse kinematic model that
enables 3D position control of the catheter’s distal tip through the EEM, and a force control algorithm based
on admittance control that converts external forces applied to the magnet into position errors, making the
system compliant that allows for safe contact with the human body. Experiment was conducted to validate
the feasibility and accuracy of the proposed control scheme. The results show that the catheter’s distal tip can
be controlled to follow desired trajectories with a minimum Root Mean Square (RMS) error of 0.43 ± 0.22 mm,
and the hybrid control scheme can reduce electrical power consumption effectively while achieving similar
performance with an RMS error of 0.52 ± 0.41 mm. It is also able to maintain contact forces within a safe
range (<15 N) during actuation.
✩ This paper was recommended for publication by Associate Editor Kaddour Bouazza-Marouf.
∗ Corresponding author at: School of Artificial Intelligence, University of Chinese Academy of Sciences, Beijing, 100049, China.
E-mail address: liuhongbin@ia.ac.cn (H. Liu).
https://doi.org/10.1016/j.mechatronics.2023.103072
Received 24 April 2023; Received in revised form 28 July 2023; Accepted 14 September 2023
Available online 27 September 2023
0957-4158/© 2023 Elsevier Ltd. All rights reserved.
Y. Huang et al. Mechatronics 95 (2023) 103072
2. Magnetically-actuated catheter
2
Y. Huang et al. Mechatronics 95 (2023) 103072
⎡ ⎡𝐿𝑖1 ⎤⎤
[ ]
[ ] ⎢ 𝒒𝑖 −𝒒𝑖 × ⎢ 0 ⎥⎥
⎥
𝑺𝑟𝑖 = ⎢ × ⎢ ⎥
⎢ ⎣ 0 ⎦⎥
⎢ 𝟎 0 ⎥
⎣ ⎦
(6)
⎡ ⎡ 𝑙 ⎤⎤
[ ] ⎢[𝟎]× ⎢0⎥⎥
𝑺𝑝 = ⎢ ⎢ ⎥⎥
⎢ ⎣0⎦⎥
⎢ 𝟎 0 ⎥⎦
⎣
The 𝐿𝑖1 denotes the distance from the proximal end to the 𝑖th
[ ]
joint when the catheter is in the initial configuration. 𝒒𝑖 × is the
Skew-symmetric matrix of 𝒒𝑖 .
𝑘𝑗 is the bending stiffness of the 𝑗th joint. The subscript 𝑏 denotes where 𝑰 ∈ 𝑅(3×3) is a 3 × 3 identity matrix. 𝒑𝑖𝑗 denotes the position
the torque and the joint’s configuration is represented in the 𝑗th joint’s [ ]
body frame. 𝒒𝑗 denotes the 𝑗th joint’s configuration, 𝝉 𝑗 is the torque vector between IPM 𝑖 and joint 𝑗, 𝒑𝑖𝑗 ∈ 𝑅(3×3) is its Skew-symmetric
×
on the joint. To construct a closed-form equation that describes the matrix.
relationship between the external magnetic field and the configuration Due to the rapid response of the elastic catheter to the external
of all joint, we rewrite (3) in the fixed global frame. wrench, it will quickly converge to the static equilibrium state when
the external magnetic field changes. The static equilibrium can be
𝝉 𝑗𝑓 = 𝑅𝑓 𝑏 𝝉 𝑗𝑏
expressed as the combination of Eqs. (4) and (7) as:
= 𝑅𝑓 𝑏 𝑘𝑗 𝒒𝑗𝑏
(4)
= 𝑘𝑗 𝑅𝑓 𝑏 𝒒𝑗𝑏 𝑲𝒒 = 𝑨𝑀 + 𝑩𝐺
= 𝑘𝑗 𝒒𝑗𝑓 ⎡ 𝑘1 𝑰 ⋯ 0 ⎤
(9)
𝑲 =⎢ ⋮ ⋱ ⋮ ⎥
where 𝑅𝑓 𝑏 is the rotation matrix between the joint frame and the fixed ⎢ ⎥
frame. According to (4), the torque of each joint is still linear with its ⎣ 0 ⋯ 𝑘𝑛+2 𝑰 ⎦
configuration in the global coordinate {𝑓 }. Thus, the configuration of where 𝑀 = [𝒎1 , … , 𝒎𝑛+2 ] and 𝐺 = [𝒈1 , … , 𝒈𝑛+2 ]. 𝑲 denotes the stiffness
the whole CR is expressed by 𝒒 = [𝒒1 , … , 𝒒𝑛+2 ] and a variable 𝑙, the matrix for all the n+2 revolute joints. To calibrate the value of 𝑲 and
forward kinematics of the catheter is written as: 𝐺, we recorded the deformation of the CR when the EEM was exposed
𝑻 (𝒒, 𝑙) = 𝑻𝑃 𝑂𝐸 𝑴(𝟎) to currents of various intensities at different locations as a dataset. The
[ ]∏
𝑛+2 [𝑺𝑟𝑖 ] unknown parameter values are estimated by minimizing the following
𝑻𝑃 𝑂𝐸 = 𝑒[𝑺𝑟1 ] 𝑒 𝑺𝑝 𝑖=2 𝑒
objective function:
⎡1 0 0 𝐿𝑛+2 ⎤ (5)
1
⎢ ⎥ ∑
𝑁
0 1 0 0 ⎥
𝑴(𝟎) = ⎢ argmin (𝒒𝑖 − 𝑲 −1 (𝑨𝑀𝑖 + 𝑩𝑖 𝐺)) (10)
⎢0 0 1 0 ⎥ 𝑲,𝐺 𝑖
⎢0 0 0 1 ⎥⎦
⎣ where 𝒒𝑖 , 𝑀𝑖 , and 𝑩𝑖 are the 𝑖th group of data in the dataset which
where 𝑻 (𝒒, 𝑙) is the transformation matrix of the tip of the catheter. are obtained through the stereo vision module of the experimental
𝐿𝑛+2
1
is the initial length of whole catheter without any advancement, platform. 𝑁 is the total number of data samples.
3
Y. Huang et al. Mechatronics 95 (2023) 103072
Fig. 3. The Hybrid Force-Magnetic Control Scheme is composed of a magnetic controller based on quadratic programming and a force controller based on admittance control.
The magnetic controller takes as input a target position 𝒙𝑑 , and the actual position 𝒙𝑐 , and produces the desired pose of EEM, the desired current, and desired advancement. The
force controller converts the external force 𝑓𝑒𝑥 applied to the EEM into its position error.
3. The hybrid force/magnetic control Apart from the state of EEM, there is another advancement vari-
able 𝑙 that controls the movement of the catheter. To incorporate the
As shown in Fig. 3, the Hybrid force/magnetic control scheme Jacobian-based control of EEM, the Jacobian matrix 𝑱𝑥𝑙 is needed. As a
consists of a magnetic controller, a force controller, and a stereo vision result of the advancement system is approximated by a prismatic joint,
system. In clinical applications, the stereo vision system can be a CT 𝑱𝑥𝑙 is derived as:
scan or X-ray, etc. MRI is not suitable due to the potential impact of its
strong magnetic field on the system. The magnetic controller converts ⎡1⎤
𝜕𝒙
the problem of steering the catheter with the EEM into a quadratic 𝑱𝑥𝑙 = = 𝑒[𝒒1 ]× ⎢0⎥ (13)
𝜕𝑙 ⎢ ⎥
programming problem, the required pose and current of the EEM are ⎣0⎦
obtained by solving it. The force controller is based on admittance
control. It treats the position of the EEM as a virtual spring and converts 𝑒[𝒒1 ]× denotes the rotation matrix corresponding to the first revolute
the measured contact force into a change in the pose of the EEM to joint. However, there is coupling effect 𝑱𝑞𝑙 between the advancement
achieve compliance control. system and the stiffness coefficient as well as the torque add on each
joint.
3.1. Jacobian-based magnetic control
𝜕(𝑲 −1 𝐹 ) 𝜕(𝑲 −1 ) 𝜕(𝑨𝑀 + 𝑩𝐺)
𝑱𝑞𝑙 = = 𝐹 + 𝑲 −1 (14)
𝜕𝑙 𝜕𝑙 𝜕𝑙
In this proposed system, we use an EEM mounted on a multi-DOF
robot as the magnetic field source to remotely actuate the CR with Advancing the catheter only increases the length of the nitinol wire
IPMs. During actuation, the EEM maintains its orientation pointing portion and changes the stiffness coefficient of the first 2 joints.
towards the center of mass of the CR. The magnetic field generated
𝜕𝑘−1
1
𝜕𝑘−1
2 1
by the EEM is approximated using the magnetic dipole model. Since = = (15)
the distance between the EEM and each IPM is much greater than the 𝜕𝑙 𝜕𝑙 2𝐸𝐼
distance between IPMs, we assume that the external magnetic field at As the length of the catheter increases, the torque from gravity
each IPM is uniform. According to (1), The magnetic torque exerted by changes due to the change of position. The matrix 𝑩 in eq (7) have
the external magnetic field on each IPM is expressed as: a gradient on 𝑙 because the relative position vector 𝒑𝑖𝑗 is determined
by 𝑙. However, only the relative position from the first joint to others
𝜇 𝝁 (𝐶) [ ] ⎡⎢ ⎤
𝑠𝑖𝑛(𝛽)
[ ]
𝒎 𝑗 = 𝝁𝑗 × 𝐵 = 0 𝑒 𝝁𝑗 × −𝑠𝑖𝑛(𝛼)𝑐𝑜𝑠(𝛽)⎥ (11) change:
2𝜋𝑟3 ⎢ ⎥
⎣ 𝑐𝑜𝑠(𝛼)𝑐𝑜𝑠(𝛽) ⎦ ⎧ ⎡1⎤
where 𝝁𝑒 (𝐶) is a 3 × 1 vector denotes the magnetic moment of EEM ⎪ 𝒒 ⎢ ⎥
𝜕𝒑𝑖𝑗 ⎪𝑒[ 1 ]× ⎢0⎥ if 𝑗 = 1
which is determined by the current 𝐶. And the vacuum permeability =⎨ ⎢ ⎥ (16)
𝜕𝑙 ⎪ ⎣0⎦
𝜇0 is 4𝜋 × 10−7 N A−2 . 𝑹𝑥 (𝛼) and 𝑹𝑦 (𝛽) denote the rotation around the
⎪0 otherwise
𝑥-axis and the 𝑦-axis respectively, and as shown in Fig. 2(a), 𝛼 and 𝛽 ⎩
are the rotation angle to indicate the magnetic field direction. 𝑟 is the
distance between the EEM and 𝑗th IPM. Therefore:
[ ] [ ]
Through chain rule, the relationship between the position of the 𝜕𝒑11 𝜕𝒑𝑛+2
⎡ ⋯ 1 ⎤
catheter’s distal tip and the state of EEM 𝒔 = [𝑟, 𝛼, 𝛽, 𝐶] is obtained from 𝜕(𝑨𝑀 + 𝑩𝐺) ⎢ 𝜕𝑙
×
𝜕𝑙
×
⎥
=⎢ ⎥ (17)
Eqs. (5), (9) and (11): 𝜕𝑙 ⎢ ⋮ ⋱ ⋮ ⎥
⎣ 0 ⋯ 0 ⎦
𝜕𝒙 𝜕𝒙 𝜕𝒒 𝜕𝑀
𝑱𝑥𝑠 = = = 𝑱𝑥𝑞 𝑱𝑞𝑀 𝑱𝑀𝑠 (12)
𝜕𝒔 𝜕𝒒 𝜕𝑀 𝜕𝒔
4
Y. Huang et al. Mechatronics 95 (2023) 103072
Algorithm 1: trajectory tracking overheated, and the lower limit of the distance between the EEM and
Input : 𝒙𝑑𝑖 : a set of target points, 𝒙: current distal tip position, 𝒒: the CR was varied to verify its influence on the control performance.
current configuration of the catheter, 𝒔: state of the EEM, The 𝑞𝑢𝑎𝑑𝑝𝑟𝑜𝑔 of C++ was used to solve it. The solution is added to the
𝑙: current length of the advancement system, ||𝛥𝒙𝑙𝑖𝑚 || The current value as 𝑆 ∗ .
limit of the step size, 𝜖: tracking threshold, 𝑡𝑡ℎ : time
threshold 3.2. Admittance force control
Output: 𝒔∗ : target state of the EEM, 𝑙∗ :target length of the
advancement system Since we make a trade-off in the objective function to minimize
energy consumption, the EEM prefers to actuate the catheter from a
𝑖 = 1, 𝑡 = 0;
close distance. However, even with a lower bound set on its pose, the
while 𝑖 < 𝑘 do
EEM may still come into contact with the patient due to the irregular
𝛥𝒙 = 𝒙𝑑𝑖 − 𝒙 ;
shape and movement of the human body. Therefore, in this study, the
𝑡 = 𝑡 + 1;
Admittance control, inspired by the Spring-damper model, is applied to
if ||𝛥𝒙|| > ||𝛥𝒙𝑙𝑖𝑚 || then
𝛥𝒙||𝜟𝒙𝒍𝒊𝒎 || ensure patient safety [34].
𝛥𝒙 = ||𝛥𝒙|| ;
𝑓𝑒𝑥 = 𝑚𝑣𝑖𝑟 𝑥̈ + 𝑑𝑣𝑖𝑟 𝑥̇ + 𝑘𝑣𝑖𝑟 (𝑥 − 𝑥∗ ) (20)
if ||𝛥𝒙|| < 𝜖 or 𝑡 > 𝑡𝑡ℎ then
𝑖 = 𝑖 + 1, 𝑡 = 0; In (19), 𝑥, 𝑥,̇ and ẍ denote the current position, velocity, and
continue; acceleration of the virtual spring. 𝑥∗ is the desired position of the virtual
else spring, which is also the pose [𝑟∗ , 𝛼 ∗ , 𝛽 ∗ ] of the EEM and given by
update jacobian Matrix → 𝑱 𝑥𝑆 ; solving eq (19). 𝑓𝑒𝑥 is the external force that can be measured by a force
quadratic programming → 𝛥𝒔, 𝛥𝑙; sensor, a pose difference of the EEM is generated to achieve compliance
𝒔∗ = 𝒔 + 𝛥𝒔, 𝑙∗ = 𝑙 + 𝛥𝑙; control if the external force exists. 𝑚𝑣𝑖𝑟 is the virtual mass of the virtual
spring, and 𝑑𝑣𝑖𝑟 is the damper parameter. The stiffness parameter 𝑘𝑣𝑖𝑟
end;
decides how compliant the virtual spring will be.
̇ 𝑣𝑖𝑟 (𝑥−𝑥∗ )
𝑓𝑒𝑥 −𝑑𝑣𝑖𝑟 𝑥−𝑘
𝑥̈ = 𝑚𝑣𝑖𝑟
̈ 2
𝑥𝑡
(21)
𝛿𝑥 = 𝑥𝑡 ̇ 𝑝 + 2𝑝
𝑡𝑝 denotes the period time of the admittance control. Although the
combination of admittance control and magnetic control allows the
EEM to act like a virtual spring and be compliant during actuation,
the generated pose error of the EEM due to external forces may re-
duce magnetic actuation accuracy and extend the operation time. To
enhance magnetic actuation performance during contact, we modify
the objective function in (19) to consider the possible contact force with
the external environment as follows:
min𝛥𝑆{𝑂(𝛥𝑆) + 𝜆2 𝑃 (𝛥𝑆)
𝜆2 if 𝑓𝑒𝑥 > 0
𝜆2 =
0 otherwise (22)
{
‖𝑘𝑒𝑛 𝛥𝑟‖2 if 𝛥𝑟 < 0
𝑃 (𝛥𝑆) =
0 otherwise
where 𝑂(𝛥𝑆) is the original objective function used in Eq. (19). 𝜆2
is a trade-off coefficient used to incorporate the possible increment
Fig. 4. The setup of the Experiment.
in contact force. 𝑃 (𝛥𝑆) is the prediction of the increment in contact
force caused by the change in the EEM’s position. If the EEM moves
closer to the catheter, denoted as 𝛥𝑟 < 0, the contact force will increase
As the system’s gradient on 𝑙 is derived, the overall relationship due to the stiffness of the external environment, and 𝑘𝑒𝑛 represents the
among variables 𝑆 = [𝑟, 𝛼, 𝛽, 𝐶, 𝑙] is known, based on eq (13), (15), and estimated stiffness as cited in [35]. By introducing the prediction of the
(17). contact force in the objective function, the magnetic control scheme
[ ]
[ ] 𝜕𝒔 will adjust the control inputs during contact, thereby shortening the
𝜕𝒙 = 𝑱𝑥𝑞 𝑱𝑞𝑀 𝑱𝑀𝑠 𝑱𝑥𝑙 + 𝑱𝑥𝑞 𝑱𝑞𝑙 actuation time.
𝜕𝑙 (18)
= 𝑱𝑥𝑆 𝜕𝑆 As shown in Fig. 3, the Hybrid Force-Magnetic Control consists of
two parts: the Jacobian-based control scheme and the high-frequency
To steer the catheter to achieve position control by magnetic actu- admittance control. The admittance control runs at a minimum fre-
ation, the magnetic control is formulated as a quadratic programming quency of 100 Hz to ensure smooth and compliant operation of the
problem. At the same time, to minimize the energy consumption of the robot.
EEM, we use a coefficient 𝜆1 to make a trade-off between the supplied
current and the control accuracy, the objective function is: 4. Experiment
min𝛥𝑆 ‖𝑱𝑥𝑆 𝛥𝑆 − 𝛥𝒙‖2 + 𝜆1 ‖𝐲1𝑇 (𝑆𝑐𝑢𝑟 + 𝛥𝑆)‖2
(19) The experiment was set up as Fig. 4, and the components are listed
s.t. 𝑆𝑙𝑜𝑤 − 𝑆𝑐𝑢𝑟 < 𝛥𝑆 < 𝑆𝑢𝑝𝑝 − 𝑆𝑐𝑢𝑟
in Table 1. The magnetically-actuated catheter was built over a hollow
𝑆𝑐𝑢𝑟 is the current value of 𝑆, 𝐲1𝑇 is a masking vector used to silicone tube (Part number: T2011, QOSINA, Edgewood, NY, USA). The
select the variable corresponding to the supplied current. 𝑆𝑙𝑜𝑤 and 𝑆𝑢𝑝𝑝 outer diameter of the tubing is 1.5 mm and its inner diameter is about
denotes the lower and upper limits of 𝑆 which are artificially selected. 1 mm. 6 rigid neodymium (NdFeb) magnets were embedded inside of
The upper limit of the current was set as 16 A to prevent the EEM to be the catheter at an equal distance. The catheter was connected with a
5
Y. Huang et al. Mechatronics 95 (2023) 103072
Fig. 5. Control performance in three different trajectories, each repeated five times. The red line indicates the desired trajectory, while the colored dots represent the actual
position of the catheter tip.
6
Y. Huang et al. Mechatronics 95 (2023) 103072
Table 3
Comparison of the hybrid force-magnetic control and the model without force control.
Energy Actuation RMS error IAE
consumption time [s] [mm] [mm s]
[kJ]
Hybrid(with 𝜆2 ) 2.96 145.9 0.5220 ± 0.41 60.11
Hybrid(without 𝜆2 ) 3.41 177.9 0.6110 ± 0.51 89.15
Bnd. 50 mm 3.16 133.4 0.4820 ± 0.28 45.25
Bnd. 55 mm 3.88 125.8 0.4906 ± 0.28 46.40
Bnd. 60 mm 5.66 128.0 0.4936 ± 0.30 45.63
Bnd. 65 mm 8.05 123.0 0.4479 ± 0.26 41.60
5. Discussion
Figs. 7(c) and 7(d) compares the actuation distance and power of the
EEM with and without force control respectively. The relevant data is
provided in Table 3. The results indicate that reducing the lower bound
of the driving distance results in a significant decrease in the total
energy consumption and peak power of the system. Optimally setting
the lower bound of the driving distance allows the EEM to operate at
the closest distance, thus minimizing the energy consumption of the
Fig. 6. Diagrams of the impact of 𝜆1 : (a) Comparison of the actuation time of control
schemes with different 𝜆1 values for different trajectories. (b) Comparison of the energy system. While obtaining precise knowledge of the patient’s anatomy in
consumption of control schemes with different 𝜆1 values. clinical settings can be challenging, the movement of the patient’s body
can also pose challenges. The Hybrid Force-Magnetic control, however,
enables the EEM to adapt to the patient’s body and operate at closer
energy consumption of the whole system. Based on statistics, the intro- distances with lower power peak and overall energy consumption by
duction of the sub-optimized objective can lead to approximately 20% setting the trade-off between driving distance and current.
energy reduction, thereby minimizing heat generation and extending However, as shown in Table 3 and Fig. 7, the Hybrid Force-Magnetic
the operational time of the system. control takes longer to complete the same trajectory compared to the
scheme without force control. The previous experiment already proves
4.2. Experiment for the hybrid force-magnetic control that the introduced trade-off parameter restricting the total current
causes no delay in the actuation time. The delay mainly comes from
To simulate potential contact with the patient during surgery, a the force control algorithm preventing the EEM from moving to the
5 mm thick silicone plate was fabricated as a protective shell for the optimal position upon contact with the platform. As shown in Fig. 7
experimental platform. A 6-axis force sensor (Product ID: M3815D, SRI, and the video attachment, if the magnetic control strategy does not take
China) was installed between the robotic manipulator’s end-effector the contact force into account, it will try to keep the EEM close to the
and the bottom of the EEM, it can measure the contact force and torque catheter, which conflicts with the force control and extends the delay.
between EEM and the silicone shell and use the contact force to change On the other hand, the control scheme that considers the possible con-
the position of the EEM and make compliant control possible. In the tact force adjusts the desired position of the EEM to move away from
experiment, we obtained the external force on the EEM by subtracting the catheter once contact happens. It also increases the supplied current
the EEM’s gravity from the force sensor data. Based on the results of to maintain the actuation of the CR, therefore reducing the actuation
the testing, it was found that the noise of the force sensor was below time, as shown in Fig. 7(d). While the Hybrid Force-Magnetic control
2.0N. Therefore, during the experiment, we defined that the EEM was with consideration of possible contact force still takes a bit longer than
in contact with the platform when the external force exceeded the noise magnetic control-only (as seen in Table 3), the delay in actuation time
threshold. has become less significant. In future clinical applications, preoperative
7
Y. Huang et al. Mechatronics 95 (2023) 103072
Fig. 7. Comparison of trajectory tracking performance between the magnetic control scheme and the Hybrid Force-Magnetic Control scheme, as well as the performance of the
Hybrid Force-Magnetic Control scheme with and without considering the possible contact force. (a) The tracking performance of the control scheme without force control on 2D
and 3D trajectories, the lower bound of the EEM’s working distance is 65 mm. (b) Tracking performance of the Hybrid Force-Magnetic Control scheme on 2D and 3D trajectories,
considering the possible contact force. (c) Comparison of the system’s actuation distances on the 3D trajectory. (d) Comparison of the system’s power consumption 𝑃 = 𝐶 2 𝑅 on
the 3D trajectory, where 𝐶 is the output current of the power supply and R is the resistance of the EEM. (e) records the normal force data collected by the force sensor in the
experiment. Further details are provided in the video attachment.
planning can be used to reduce potential contact and further minimize consumption is especially advantageous as it reduces the generation
actuation time. of heat, allowing for an extended working time without the risk of
Fig. 7(e) records the normal force collected by the force sensor overheating.
during the experiment. Comparison of Fig. 7(c) and Fig. 7(e) shows
Moreover, the proposed Hybrid Force-Magnetic Control enables
that the Hybrid Force-Magnetic control is able to control the EEM
compliant contact between the EEM and the patient, thereby reducing
appropriately away from the silicone plate when contact occurs. The
the risk of accidental injury during surgical procedures. Additionally, it
maximum contact force during the experiment was less than 15N,
which is below the maximum force recommended for ultrasound scan- further reduces the system’s energy consumption as it allows the EEM
ning on patients [36]. This demonstrates that the proposed scheme to actuate the CR from a close distance. To reduce the delay in actuation
allows for compliant contact between the EEM and the patient. time caused by contact between the EEM and the patient, we introduce
a sub-optimized objective of minimizing the possible increment in con-
6. Conclusion tact force to the Hybrid Force-Magnetic control scheme. This objective
predicts the potential increment in contact force and moves the EEM
This paper has presented a Hybrid Magnetic-Force Control scheme away from the patient once contact occurs, while still maintaining the
combining a Jacobian-based control scheme and the Admittance Con- actuation of the CR. This sub-optimized objective reduces actuation
trol. The proposed control scheme transforms the magnetic control of time by 17.9% when contact is present.
the catheter into a multi-objective optimization problem by introducing
In future studies, further research will focus on giving the catheter
a sub-optimized objective on the amount of supplied current. This
more diverse motion modes so that it can adapt to more complex
allows for precise 3D trajectory tracking of the magnetic catheter
with reduced energy consumption. Experimental results proved that environments. Although it has been proven that the proposed control
the proposed scheme enables 3D trajectory tracking with an accuracy scheme can drive the catheter for position control, Optimizing the
of up to 0.43 ± 0.22mm. Furthermore, the proposed scheme signifi- modeling of catheter kinematics, making its control more accurate, and
cantly reduces the system’s energy consumption by approximately 20%, realizing effective intervention will continue to be a research direction
while maintaining similar tracking precision. This reduction in energy in the future.
8
Y. Huang et al. Mechatronics 95 (2023) 103072
CRediT authorship contribution statement [11] Pittiglio G, Lloyd P, da Veiga T, Onaizah O, Pompili C, Chandler JH, et al.
Patient-specific magnetic catheters for atraumatic autonomous endoscopy, Soft
Robot, https://doi.org/10.1089/soro.2021.0090, PMID: 35312350.
Yuanrui Huang: Conceptualization, Methodology, Software, Vali-
[12] Jeon S, Hoshiar AK, Kim S. Improving guidewire-mediated steerability of a
dation, Formal analysis, Investigation, Data curation, Writing – origi-
magnetically actuated flexible microrobot. Micro Nano Syst Lett 2018;6. http:
nal draft, Visualization. Runyu Ma: Validation, Investigation, Writing //dx.doi.org/10.1186/s40486-018-0077-y.
– review & editing. Hongbin Liu: Conceptualization, Writing – re- [13] Jeon SM, Jang GH. Precise steering and unclogging motions of a catheter with a
view & editing, Resources, Supervision, Funding acquisition, Project rotary magnetic drill tip actuated by a magnetic navigation system. IEEE Trans
administration. Magn 2012;48(11):4062–5. http://dx.doi.org/10.1109/TMAG.2012.2194480.
[14] Sikorski J, Denasi A, Bucchi G, Scheggi S, Misra S. Vision-based 3-D control of
magnetically actuated catheter using BigMag—An array of mobile electromag-
Declaration of competing interest netic coils. IEEE/ASME Trans Mechatronics 2019;24(2):505–16. http://dx.doi.
org/10.1109/TMECH.2019.2893166.
The authors declare that they have no known competing finan- [15] Richter M, Venkiteswaran VK, Misra S. Multi-point orientation control
cial interests or personal relationships that could have appeared to of discretely-magnetized continuum manipulators. IEEE Robot Autom Lett
influence the work reported in this paper. 2021;6(2):3607–14. http://dx.doi.org/10.1109/LRA.2021.3064285.
[16] Jeon S, Hoshiar AK, Kim K, Lee S, Kim E, Lee S, et al. A magnetically
controlled soft microrobot steering a guidewire in a three-dimensional phantom
Data availability vascular network. Soft Robot 2019;6(1):54–68. http://dx.doi.org/10.1089/soro.
2018.0019, PMID: 30312145.
No data was used for the research described in the article. [17] Lin D, Jiao N, Wang Z, Liu L. A magnetic continuum robot with multi-
mode control using opposite-magnetized magnets. IEEE Robot Autom Lett
2021;6(2):2485–92. http://dx.doi.org/10.1109/LRA.2021.3061376.
Acknowledgments
[18] Lloyd P, Pittiglio G, Chandler JH, Valdastri P. Optimal design of soft continuum
magnetic robots under follow-the-leader shape forming actuation. In: 2020
This work was supported by the Institute of Automation, Chinese International symposium on medical robotics. 2020, p. 111–7. http://dx.doi.org/
Academy of Sciences, and the InnoHK programme. 10.1109/ISMR48331.2020.9312943.
[19] Hong A, Petruska AJ, Zemmar A, Nelson BJ. Magnetic control of a flexible needle
in neurosurgery. IEEE Trans Biomed Eng 2021;68(2):616–27. http://dx.doi.org/
Appendix A. Supplementary data
10.1109/TBME.2020.3009693.
[20] Lin D, Wang J, Jiao N, Wang Z, Liu L. A flexible magnetically controlled
Supplementary material related to this article can be found online continuum robot steering in the enlarged effective workspace with constraints
at https://doi.org/10.1016/j.mechatronics.2023.103072. for retrograde intrarenal surgery. Adv Intell Syst 2021;3(10):2000211. http:
//dx.doi.org/10.1002/aisy.202000211.
[21] Hwang J, Kim J-y, Choi H. A review of magnetic actuation systems and
References
magnetically actuated guidewire- and catheter-based microrobots for vascular
interventions. Intell Serv Robot 2020;13(1):1–14. http://dx.doi.org/10.1007/
[1] Graetzel CF, Sheehy A, Noonan DP. Robotic bronchoscopy drive mode of the s11370-020-00311-0.
Auris Monarch platform. In: 2019 International conference on robotics and [22] Mahoney AW, Abbott JJ. Five-degree-of-freedom manipulation of an untethered
automation. 2019, p. 3895–901. http://dx.doi.org/10.1109/ICRA.2019.8793704. magnetic device in fluid using a single permanent magnet with application in
[2] Ikuta K, Ichikawa H, Suzuki K, Yajima D. Multi-degree of freedom hydraulic stomach capsule endoscopy. Vol. 35. No. 1–3. USA: Sage Publications, Inc; 2016,
pressure driven safety active catheter. In: Proceedings 2006 IEEE international p. 129–47. http://dx.doi.org/10.1177/0278364914558006.
conference on robotics and automation, 2006. 2006, p. 4161–6. http://dx.doi. [23] Pittiglio G, Chandler JH, Richter M, Venkiteswaran VK, Misra S, Valdastri P.
org/10.1109/ROBOT.2006.1642342. Dual-arm control for enhanced magnetic manipulation. In: 2020 IEEE/RSJ
[3] Chen G, Pham MT, Redarce T. Development and kinematic analysis of a silicone- international conference on intelligent robots and systems. 2020, p. 7211–8.
rubber bending tip for colonoscopy. In: 2006 IEEE/RSJ international conference http://dx.doi.org/10.1109/IROS45743.2020.9341250.
on intelligent robots and systems. 2006, p. 168–73. http://dx.doi.org/10.1109/ [24] Heunis CM, Wotte YP, Sikorski J, Furtado GP, Misra S. The ARMM system -
IROS.2006.282129. Autonomous steering of magnetically-actuated catheters: Towards endovascular
[4] Burgner-Kahrs J, Rucker DC, Choset H. Continuum robots for medical appli- applications. IEEE Robot Autom Lett 2020;5(2):705–12. http://dx.doi.org/10.
cations: A survey. IEEE Trans Robot 2015;31(6):1261–80. http://dx.doi.org/10. 1109/LRA.2020.2965077.
1109/TRO.2015.2489500. [25] Yang Z, Yang L, Zhang M, Wang Q, Yu SCH, Zhang L. Magnetic control of
[5] da Veiga T, Chandler JH, Lloyd P, Pittiglio G, Wilkinson NJ, Hoshiar AK, et al. a steerable guidewire under ultrasound guidance using mobile electromagnets.
Challenges of continuum robots in clinical context: A review. Progr Biomed Eng IEEE Robot Autom Lett 2021;6(2):1280–7. http://dx.doi.org/10.1109/LRA.2021.
2020;2(3):032003. http://dx.doi.org/10.1088/2516-1091/ab9f41. 3057295.
[6] Roberts T, Hassenzahl W, Hetts S, Arenson R. Remote control of [26] Sikorski J, Dawson I, Denasi A, Hekman EE, Misra S. Introducing BigMag —
catheter tip deflection: An opportunity for interventional MRI. Magn A novel system for 3D magnetic actuation of flexible surgical manipulators. In:
Reson Med 2002;48(6):1091–5. http://dx.doi.org/10.1002/mrm.10325, 2017 IEEE international conference on robotics and automation. 2017, p. 3594–9.
arXiv:https://onlinelibrary.wiley.com/doi/pdf/10.1002/mrm.10325. URL http://dx.doi.org/10.1109/ICRA.2017.7989413.
https://onlinelibrary.wiley.com/doi/abs/10.1002/mrm.10325. [27] Pittiglio G, Brockdorff M, da Veiga T, Davy J, Chandler JH, Valdastri P.
[7] Gudino N, Heilman JA, Derakhshan JJ, Sunshine JL, Duerk JL, Griswold MA. Collaborative magnetic manipulation via two robotically actuated permanent
Control of intravascular catheters using an array of active steering coils. Med magnets. IEEE Trans Robot 2022;1–12. http://dx.doi.org/10.1109/TRO.2022.
Phys 2011;38(7):4215–24. http://dx.doi.org/10.1118/1.3600693, arXiv:https:// 3209038.
aapm.onlinelibrary.wiley.com/doi/pdf/10.1118/1.3600693. URL https://aapm. [28] Lin D, Chen W, He K, Jiao N, Wang Z, Liu L. Position and orientation control
onlinelibrary.wiley.com/doi/abs/10.1118/1.3600693. of multisection magnetic soft microcatheters. IEEE/ASME Trans Mechatronics
[8] Liu T, Poirot NL, Franson D, Seiberlich N, Griswold MA, Çavuşoğlu MC. Modeling 2022;1–12. http://dx.doi.org/10.1109/TMECH.2022.3213934.
and validation of the three-dimensional deflection of an MRI-compatible magnet- [29] Kim Y, Genevriere E, Harker P, Choe J, Balicki M, Regenhardt RW, et al.
ically actuated steerable catheter. IEEE Trans Biomed Eng 2016;63(10):2142–54. Telerobotic neurovascular interventions with magnetic manipulation. Science
http://dx.doi.org/10.1109/TBME.2015.2510743. Robotics 2022;7(65):eabg9907. http://dx.doi.org/10.1126/scirobotics.abg9907,
[9] Kim Y, Parada GA, Liu S, Zhao X. Ferromagnetic soft continuum robots. Science arXiv:https://www.science.org/doi/pdf/10.1126/scirobotics.abg9907. URL https:
Robotics 2019;4(33):eaax7329. http://dx.doi.org/10.1126/scirobotics.aax7329, //www.science.org/doi/abs/10.1126/scirobotics.abg9907.
arXiv:https://www.science.org/doi/pdf/10.1126/scirobotics.aax7329. URL https: [30] Edelmann J, Petruska AJ, Nelson BJ. Magnetic control of continuum devices.
//www.science.org/doi/abs/10.1126/scirobotics.aax7329. Vol. 36. No. 1. USA: Sage Publications, Inc; 2017, p. 68–85. http://dx.doi.org/
[10] Zhang S, Yin M, Lai Z, Huang C, Wang C, Shang W, et al. Design and 10.1177/0278364916683443.
characteristics of 3D magnetically steerable guidewire system for minimally [31] Roesthuis RJ, Misra S. Steering of multisegment continuum manipulators
invasive surgery. IEEE Robot Autom Lett 2022;7(2):4040–6. http://dx.doi.org/ using rigid-link modeling and FBG-based shape sensing. IEEE Trans Robot
10.1109/LRA.2022.3146909. 2016;32(2):372–82. http://dx.doi.org/10.1109/TRO.2016.2527047.
9
Y. Huang et al. Mechatronics 95 (2023) 103072
[32] Venkiteswaran VK, Palao JJ, Misra S. A magnetically-steerable stenting catheter Runyu Ma received the B.Eng from the School of Gen-
for minimally invasive cardiovascular interventions. In: 2021 IEEE/ASME in- eral Engineering at Beihang University, China . He is
ternational conference on advanced intelligent mechatronics. 2021, p. 848–54. currently working towards Master degree with Department
http://dx.doi.org/10.1109/AIM46487.2021.9517686. of Cognitive Robotics, Delft University of Technology, The
[33] Greigarn T, Çavuşoğlu MC. Pseudo-rigid-body model and kinematic analysis of Netherlands. His current research interests include the
MRI-actuated catheters. In: 2015 IEEE international conference on robotics and autonomous control and machine learning for robotics.
automation. 2015, p. 2236–43. http://dx.doi.org/10.1109/ICRA.2015.7139495.
[34] Hogan N. Impedance control: An approach to manipulation. In: 1984 American
control conference. 1984, p. 304–13. http://dx.doi.org/10.23919/ACC.1984.
4788393.
[35] Gold T, Völz A, Graichen K. Model predictive interaction control for robotic Hongbin Liu is a Professor at Chinese Academy of Sciences,
manipulation tasks. IEEE Trans Robot 2023;39(1):76–89. http://dx.doi.org/10. Institute of Automation (CASIA), Executive Deputy Director
1109/TRO.2022.3196607. for the Centre of AI and Robotics (CAIR), Hong Kong
[36] Gilbertson MW, Anthony BW. Force and position control system for freehand Institute of Science & Innovation, Chinese Academy of
ultrasound. IEEE Trans Robot 2015;31(4):835–49. http://dx.doi.org/10.1109/ Sciences. Dr Liu is also an adjunct Reader and director of the
TRO.2015.2429051. Haptic Mechatronics and Medical Robotics (HaMMeR) lab at
the School of Biomedical Engineering and Imaging Sciences,
King’s College London (KCL), UK. Dr Liu’s group has been
focusing on research and development of medical robotic
Yuanrui Huang received the M.Sc. in Intelligent Systems
systems with advanced haptic perception and interaction
from King’s College London and the B.Eng in Electronic
capabilities, to enable safer and more effective minimally
Information Engineering from Chongqing University, China.
invasive diagnosis and treatment for patients. Dr Liu’s
He is currently working towards Ph.D degree with the
research has led to the clinical translation of a series of
School of Artificial Intelligence, University of Chinese
flexible robotic endoscopic systems for applications such as
Academy of Sciences, and also with the State Key Labora-
colonoscopy, bronchoscopy as well as vascular surgeries. Dr
tory of Multimodal Artificial Intelligence Systems, Institute
Liu received Ph.D. degree from King’s College London in
of Automation, Chinese Academy of Sciences. His current
2010, and published over 110 peer-reviewed articles with a
research interests include robust and intelligent control for
H-index 39.
magnetic microrobots and medical devices.
10