# Position Encoder Analysis and Low Delay Control for a Medical Robot with Six DoFs

Authors: Wenyuan Liang; Xiaobo Zhou; Qing Lan
Journal: Journal of Sensors
 (2022)

---

## Abstract

Medical robots are in great demand for orthopedic surgery. The robotic control could be divided into two layers, the top layer and the bottom layer (also called joint control). However, how to improve the dynamic performance of joint control is still a challenging issue. Traditional PID control and PID-based sliding mode control are commonly used methods for the joint control of medical and industrial robots. In this paper, the proposed joint control is based on dynamic compensation. Dynamic compensation includes inertia and friction. The joint control diagram includes PID, sliding mode control, and adaptive dynamic compensation as a module unit. The design of the proposed joint control method could overcome the disadvantages of model uncertainty and dynamic disturbances and improve robot dynamic performance. Additionally, since control feedback is based on the joint position encoder, position encoder analysis is included in this paper. The dynamic performance of the proposed joint control was tested on the six-DoF medical robot, and the indexes of rising time, task space tracking, and contact space tracking were adopted to evaluate the dynamic performance. The experimental results show that the proposed control method has a much smaller rising time than the commercial controller product. The control proposed in this paper realized low delay control and improved the dynamic response of the control.


---

## Body

## 1. Introduction

Many medical robots are being developed for surgery (Figure1 shows examples of medical robot applications) to realize better operation performance that is more precise and minimally invasive, compared with traditional manual procedures.Figure 1
Examples of medical robot applications in surgery: (a) orthopedic surgery and (b) neurosurgery.
(a)(b)Research related to medical robots for orthopedic surgery began in the mid-1980s [1, 2]. The orthopedic medical robots are supposed to play an important role in orthopedic surgery. The role of orthopedic medical robots is divided into two kinds of essential features. The first feature is that the orthopedic medical robots can be used for bone cutting/drilling/milling, and the second feature is that the orthopedic medical robots can be used for holding/placing surgical tools [3].The basic requirements for medical robots are safe, reproducible, and precise [1]. One of these mentioned requirements is to provide more precise control during robotic surgical procedures. The robotic control could be divided into two layers (see Figure 2), the top layer and the bottom layer. The top layer focuses on manipulation planning, and the bottom layer focuses on joint control [4, 5]. Both the top layer and the bottom layer could improve the precise control of the robot.Figure 2
General robotic control diagram (top layer and bottom layer).This paper will focus on the joint control of the medical robot. For the joint control, the key is its dynamic performance. The indexes of the dynamic performance of joint control are included in [4, 6]. In this paper, the indexes of rising time, task space tracking, and contact space tracking will be adopted to test the dynamic performance of the controller.To date, orthopedic medical robots, such as MAKO, Robodoc, Praxim, and Navio, have good performance on clinical surgical tasks [7]. However, how to improve the control performance and reduce the delay time of joint control [8] is still a challenging issue in robotics.In early robotic applications, because PID control [9] has a simple structure and easy adjustment, PID control is used as a component of joint control and is widely used in both industrial robots and medical robots. With the development of robotic applications, traditional joint control cannot meet the requirements that are of good dynamic characteristics and high precision result [10]. Therefore, many improved joint control methods have been proposed [11–13]. Intelligent methods for PID tuning are adopted to improve the joint control performance. In [11], some autotuning methods have been proposed by researchers. Since PID fails in the case of uncertain environment, to realize high-precision trajectory tracking under model uncertainty and external disturbances, researchers have adopted a sliding mode control (SMC) method that includes PID and sliding mode control. In [12], it lists different configurations of PID-based SMC to overcome the drawbacks of PID. In [13], researchers combine the fuzzy gain tuning, the robustness of the sliding mode controller, and the rapid response characteristics of the PID, which effectively reduces the chattering caused by the sliding mode controller and improves the stability of the system. Although PID-based SMC has the advantages of tracking trajectory with high precision and overcoming the uncertain environment, it still has a limit on dynamic performance.The essence of dynamic performance of the joint control is bandwidth. Both tuning control parameters and dynamic compensation are approaches to improve bandwidth. Improving the bandwidth could reduce the delay time of the control response [14]. However, researchers [9–13] focus on tuning the control parameters, and the research on the dynamic compensation of the joint control (bottom layer) is much less.By considering that dynamic compensation is also a good approach to reduce the delay time of the joint control, this paper will improve the dynamic characteristics of the joint control by adding dynamic compensation. Dynamic compensation includes inertia and friction.In this paper, the main contribution of the proposed method over the previous methods is the joint control diagram which includes PID, sliding mode control, and adaptive dynamic compensation as a module unit. The design of the proposed joint control method could overcome the disadvantages of model uncertainty and dynamic disturbances and improve the dynamic performance of robot.The structure of this paper is as follows. In the second section, the VDC method [5] is used to build the kinematics of the 6-DoF medical robot. In the third section, it shows an improved control approach that combines joint control and dynamic compensation. Since control feedback is based on the joint position encoder, the position encoder analysis included in the fourth section will discuss how to determine the data bits and sampling time. The control performance is shown in the fifth section.


## 2. Kinematics of the 6-DoF Medical Robot

In this paper, the medical robot is with six DoFs (see Figure3), and its load capacity is 10 kg. In the project, this robot is supposed to be used for drilling and placing. From the base to the end effector, the six joints are labeled as J1–J6. All six joints are the type of rotational joint.Figure 3
Medical robot with six DoFs for knee joint surgery.For the 6-DoF robot, the inertial coordinate frame is defined asF0‐x0y0z0; the coordinate frame for the end effector is labeled as Fee‐xeeyeezee; the coordinate frame for the ith (i=1,2,⋯,6) joint is Fi‐xiyizi, and the direction of the axis zi aligns with the rotational axis of the ith joint, respectively.Based on the VDC method [5], the 6-DoF robot is virtually decomposed into six subsystems by placing six cutting points at the six joints, respectively. As illustrated in Figure 4, a cutting point is an interface of separation that virtually cuts through the ith joint. The ith joint is located between the i−1th link and the ith link. For the ith joint, two coordinate frames are defined. The first is the inboard frame Fi^ which is attached on Link i‐1 and labeled with Fi^−xi^yi^zi^, and the second is the outboard frame Fi which is attached on Link i and labeled with Fi‐xiyizi. Therefore, while the ith joint rotates with θi, the outboard frame Fi will rotate along the axis zi^ as θi with respect to the inboard frame Fi^. If θi=0, frame Fi and frame Fi^ will share the same position and orientation at the cutting point. Since frame Fi^ and frame Fi−1 are attached on the same Link i−1, the rotation matrices Ci−1i^ between frame Fi−1 and frame Fi^ are constant. The rotation matrices associated with inboard frame and outboard frame can be expressed as
(1)Cii^=cosθi−sinθi0sinθicosθi0001.Figure 4
Inboard frame and outboard frame of theith joint.The transformation matrices between inboard frame and outboard frame are defined as(2)Ti^i−1=Ci^i−1−Ci^i−1⋅ri−ri−1,i^03×3Ci^i−1,(3)Ti^i−1=Ci^i03×303×3Ci^i,where in Equation (2), is ri−ri−1,i^ the position vector between the origin of frame Fi^ and the origin of frame Fi−1 that is expressed in frame Fi−1, and the cross-product operator is defined as
(4)r×=r1r2r3×=0−r3r2r30−r1−r2r10.Based on Table1, which shows the D-H parameters of the 6-DoF robot, it can derive the following.
(5)r0,1^=0,0,a0′0,C1^=−1,0,0;0,−1,0;0,0,1′0,r1,2^=0,0,a1′1,C2^=0,−1,0;0,0,−1;1,0,0′1,(6)r2,3^=a2,0,0′2,C3^=0,−1,0;−1,0,0;0,0,−1′2,r3,4^=0,−a3,0′3,C4^=1,0,0;0,0,−1;0,1,0′3,r4,5^=0,0,a4′4,C5^=1,0,0;0,0,1;0,−1,0′4,r5,6^=0,−a5,0,′5,C6^=1,0,0;0,0,−1;0,1,0′5.Table 1
D-H parameters of the 6-DoF robot.
θidi (unit: m)ai−1 (unit: m)αi−1Joint 1θ10.26090°Joint 2θ200.48180°Joint 3θ30090°Joint 4θ40.520−90°Joint 5θ50090°Joint 6θ60.19600°Hence, for the 6-DoF robot, the transformation matrix from the base to the end effector is(7)T06=T01^∙T1^1∙T12^∙T2^2∙T23^∙T3^3∙T34^∙T4^4∙T45^∙T5^5∙T56^∙T6^6.


## 3. Dynamics and Controller of the 6-DoF Medical Robot

In this paper, the control is model-based. The classical adaptive identification method [15, 16] was adopted to identify the inertial parameters in this research project. However, in previous research, the adaptive identification method was not included in the joint control structure of joint control, and it was included in the top layer of the control of the system.In this section, the first part will build the dynamics of the subsystem, and the second part will show the joint control based on dynamic compensation.


### 3.1. Dynamics of the Subsystem

As mentioned above, the full system of the 6-DoF robot is virtually decomposed into six subsystems. This part will discuss the velocity transformation, force transformation, and dynamics of the subsystem.For the velocity transformation, the defined labels have the corresponding meanings:vii represents that the linear velocity of target (vi) is with respect to the origin of the frame Fi and is expressed in frame Fi; ωii represents that the angular velocity of the target (ωi) is with respect to the origin of the frame Fi and is expressed in frame Fi. Then, the following will hold:
(8)viiwii=Tii^⋅vi^i^wi^i^+03×1z⟶i⋅θ̇i,vi+1^i+1^wi+1^i+1^=Ti+1^i⋅viiwii,Tii^=Cii^03×303×3Cii^,Ti+1^=Ci^i−Ci^i⋅rii,mi×03×3Ci^i,where ri,mii is the CoM (center of mass) position of Link i that is expressed in frame Fi.For the force transformation, the defined labels have the corresponding meanings:finet,i represents the vector sum of the force (except the gravitational force) that is acting on Link i and expressed in frame Fi; minet,i represents the vector sum of the moment of force (except the contribution of the gravitational force) that is acting on Link i and expressed in frame Fi. τnet,i represents the sum of torque that is acting on the ith joint. Then, Equations (9) and (10) will hold.
(9)fiimii=Ti+1^iT⋅fi+1^i+1^mi+1^i+1^+finet,iminet,i,(10)fi^i^mi^i^=Tii^T⋅fiimii+03×1z⟶i⋅τinet,i,where in Equations (9) and (10), fii,fi^i^,fi+1^i+1^ and mii,mi^i^,mi+1^i+1^ are all the intermediate calculation results.For theith subsystem, mi is the mass of Link i, Ii is the moment of inertia of Link i which is with respect to the CoM of Link i, and g⟶ is the gravity vector. Then, the dynamics of the ith subsystem is expressed as
(11)Mi∙v̇iiω̇ii+Ci∙viiωii+Gi=fnet,iimnet,ii,where
(12)Mi=mi∙I3×3−mi∙rii,mi×mi∙rii,mi×Ii−mi∙rii,mi×2,Ci=mi∙ωii×−mi∙ωii×∙rii,mi×mi∙rii,mi×∙ωii×ωii×∙Ii+Ii∙ωii×−mi∙rii,mi×∙ωii×∙rii,mi×,Gi=−mi∙Ci0∙g⟶−mi∙rii,mi×∙Ci0∙g⟶.


### 3.2. Control Based on Dynamic Compensation

In this paper, the model-based design is adopted to set up the controller. The classical adaptive identification method [15, 16] was adopted to identify the inertial parameters in the bottom layer of control. Additionally, joint control is the basic of full-system control. Optimizing the joint control can improve reducing the delay time of the dynamic response. Therefore, in this part, the discussions will focus on joint control.In Equation (13), it shows the common sliding mode control. θd,i and θ̇d,i are the command of the ith joint position and velocity, respectively. For the control coefficient, there is λi>0.
(13)θ̇r,i=θ̇d,i+λi∙θd,i−θi.For theith joint, its control law is defined as Equation (14). In the right part of Equation (14), the first three items play the role of dynamic compensation, and the last three items play the role of control.
(14)τnet,ii=Ij,i∙θ¨r,i+k^c,i∙signθ̇r,i+k^v,i∙θ̇r,i+kP,i∙θe,i+kI,i∙∫θe,i+kD,i∙θ̇e,i.Additionally,θe,i=θd,i−θi, θ̇e,i=θ̇d,i−θ̇i; k^c,i is the estimated value for the Coulomb friction coefficient of the ith joint, and k^v,i is the estimated value for the viscous friction coefficient of the ith joint; kP,i, kI,i, and kD,i are the PID control parameters.In Equation (14), Ij,i, k^c,i, and k^v,i are the unknown variables. The inertial variable Ij,i was identified based on the classical adaptive identification method [15, 16] by the top layer of control. k^c,i and k^v,i are identified by using the following equations: Equations (15)–(17). k¯c,i and k¯c,i are supremum and infimum for kc,i, respectively; k¯v,i and k¯v,i are supremum and infimum for kv,i, respectively. The function P is the identification function [4], and its time derivative is shown in Equation (17).
(15)sc,isv,i=signθ̇r,iθ̇r,i∙θ̇e,i+λi∙θe,i,(16)k^c,ik^v,i=Pc,isc,i,ρc,i,k¯c,i,k¯c,i,tPv,isv,i,ρv,i,k¯v,i,k¯v,i,t,(17)Ṗst,ρ,k¯,k¯,t=0,ifP≥k¯ands≥0,0,ifP≤k¯ands≤0,ρ∙st,otherwise.Finally, the computation result ofτnet,ii in Equation (14) is substituted into Equation (10). Then, a complete dynamic equation of the subsystem shown in Equation (11) is obtained. The matrices of Mi, Ci, and Gi are also identified based on the classical adaptive identification method [15, 16].


## 3.1. Dynamics of the Subsystem

As mentioned above, the full system of the 6-DoF robot is virtually decomposed into six subsystems. This part will discuss the velocity transformation, force transformation, and dynamics of the subsystem.For the velocity transformation, the defined labels have the corresponding meanings:vii represents that the linear velocity of target (vi) is with respect to the origin of the frame Fi and is expressed in frame Fi; ωii represents that the angular velocity of the target (ωi) is with respect to the origin of the frame Fi and is expressed in frame Fi. Then, the following will hold:
(8)viiwii=Tii^⋅vi^i^wi^i^+03×1z⟶i⋅θ̇i,vi+1^i+1^wi+1^i+1^=Ti+1^i⋅viiwii,Tii^=Cii^03×303×3Cii^,Ti+1^=Ci^i−Ci^i⋅rii,mi×03×3Ci^i,where ri,mii is the CoM (center of mass) position of Link i that is expressed in frame Fi.For the force transformation, the defined labels have the corresponding meanings:finet,i represents the vector sum of the force (except the gravitational force) that is acting on Link i and expressed in frame Fi; minet,i represents the vector sum of the moment of force (except the contribution of the gravitational force) that is acting on Link i and expressed in frame Fi. τnet,i represents the sum of torque that is acting on the ith joint. Then, Equations (9) and (10) will hold.
(9)fiimii=Ti+1^iT⋅fi+1^i+1^mi+1^i+1^+finet,iminet,i,(10)fi^i^mi^i^=Tii^T⋅fiimii+03×1z⟶i⋅τinet,i,where in Equations (9) and (10), fii,fi^i^,fi+1^i+1^ and mii,mi^i^,mi+1^i+1^ are all the intermediate calculation results.For theith subsystem, mi is the mass of Link i, Ii is the moment of inertia of Link i which is with respect to the CoM of Link i, and g⟶ is the gravity vector. Then, the dynamics of the ith subsystem is expressed as
(11)Mi∙v̇iiω̇ii+Ci∙viiωii+Gi=fnet,iimnet,ii,where
(12)Mi=mi∙I3×3−mi∙rii,mi×mi∙rii,mi×Ii−mi∙rii,mi×2,Ci=mi∙ωii×−mi∙ωii×∙rii,mi×mi∙rii,mi×∙ωii×ωii×∙Ii+Ii∙ωii×−mi∙rii,mi×∙ωii×∙rii,mi×,Gi=−mi∙Ci0∙g⟶−mi∙rii,mi×∙Ci0∙g⟶.


## 3.2. Control Based on Dynamic Compensation

In this paper, the model-based design is adopted to set up the controller. The classical adaptive identification method [15, 16] was adopted to identify the inertial parameters in the bottom layer of control. Additionally, joint control is the basic of full-system control. Optimizing the joint control can improve reducing the delay time of the dynamic response. Therefore, in this part, the discussions will focus on joint control.In Equation (13), it shows the common sliding mode control. θd,i and θ̇d,i are the command of the ith joint position and velocity, respectively. For the control coefficient, there is λi>0.
(13)θ̇r,i=θ̇d,i+λi∙θd,i−θi.For theith joint, its control law is defined as Equation (14). In the right part of Equation (14), the first three items play the role of dynamic compensation, and the last three items play the role of control.
(14)τnet,ii=Ij,i∙θ¨r,i+k^c,i∙signθ̇r,i+k^v,i∙θ̇r,i+kP,i∙θe,i+kI,i∙∫θe,i+kD,i∙θ̇e,i.Additionally,θe,i=θd,i−θi, θ̇e,i=θ̇d,i−θ̇i; k^c,i is the estimated value for the Coulomb friction coefficient of the ith joint, and k^v,i is the estimated value for the viscous friction coefficient of the ith joint; kP,i, kI,i, and kD,i are the PID control parameters.In Equation (14), Ij,i, k^c,i, and k^v,i are the unknown variables. The inertial variable Ij,i was identified based on the classical adaptive identification method [15, 16] by the top layer of control. k^c,i and k^v,i are identified by using the following equations: Equations (15)–(17). k¯c,i and k¯c,i are supremum and infimum for kc,i, respectively; k¯v,i and k¯v,i are supremum and infimum for kv,i, respectively. The function P is the identification function [4], and its time derivative is shown in Equation (17).
(15)sc,isv,i=signθ̇r,iθ̇r,i∙θ̇e,i+λi∙θe,i,(16)k^c,ik^v,i=Pc,isc,i,ρc,i,k¯c,i,k¯c,i,tPv,isv,i,ρv,i,k¯v,i,k¯v,i,t,(17)Ṗst,ρ,k¯,k¯,t=0,ifP≥k¯ands≥0,0,ifP≤k¯ands≤0,ρ∙st,otherwise.Finally, the computation result ofτnet,ii in Equation (14) is substituted into Equation (10). Then, a complete dynamic equation of the subsystem shown in Equation (11) is obtained. The matrices of Mi, Ci, and Gi are also identified based on the classical adaptive identification method [15, 16].


## 4. Position Encoder Analysis

In this paper, the position encoders are fixed on the motor axis of each joint. In this section, it will discuss how to choose the position encoders based on the simulation analysis.


### 4.1. Data Bits Requirement Analysis

As well known, data bits output by the encoder during one round of the encoder shaft will determine the encoder resolution. If an encoder has insufficient resolution, it will not provide effective feedback to the controller, and the system will not perform as required.In the data bits analysis, the target velocity is set as 0.2 deg/s (see Figure5(a)), and the gear ratio for each motor is 160 : 1. Two types of encoder are adopted to detect the actual velocity. Figure 5(b) shows the recording result of the encoder with 15 data bits. Figure 5(c) shows the recording result of the encoder with 16 data bits.Figure 5
Encoder output comparison with different data bits.
(a)(b)(c)Based on the comparisons, especially in the duration from start to 1 second, it shows that the encoder with 16 data bits has better tracking performance than the encoder with 15 data bits. Therefore, in this paper, the robot controller is based on the position encoders with 16 data bits.


### 4.2. Sampling Time Requirement Analysis

Since the computation resource is limited, it is needed to choose an appropriate sampling time of the encoder. Figure6(a) shows the recording result of the encoder with a sampling time of 0.1 ms. Figure 6(b) shows the recording result of the encoder with sampling time of 0.25 ms.Figure 6
Encoder output comparison with different sampling times.
(a)(b)By comparing the encoder performance of recording continuity, it shows that the encoder with 0.1 ms sampling time is better. Therefore, in this paper, the robot controller is based on position encoders with a sampling time of 0.1 ms sampling time.


## 4.1. Data Bits Requirement Analysis

As well known, data bits output by the encoder during one round of the encoder shaft will determine the encoder resolution. If an encoder has insufficient resolution, it will not provide effective feedback to the controller, and the system will not perform as required.In the data bits analysis, the target velocity is set as 0.2 deg/s (see Figure5(a)), and the gear ratio for each motor is 160 : 1. Two types of encoder are adopted to detect the actual velocity. Figure 5(b) shows the recording result of the encoder with 15 data bits. Figure 5(c) shows the recording result of the encoder with 16 data bits.Figure 5
Encoder output comparison with different data bits.
(a)(b)(c)Based on the comparisons, especially in the duration from start to 1 second, it shows that the encoder with 16 data bits has better tracking performance than the encoder with 15 data bits. Therefore, in this paper, the robot controller is based on the position encoders with 16 data bits.


## 4.2. Sampling Time Requirement Analysis

Since the computation resource is limited, it is needed to choose an appropriate sampling time of the encoder. Figure6(a) shows the recording result of the encoder with a sampling time of 0.1 ms. Figure 6(b) shows the recording result of the encoder with sampling time of 0.25 ms.Figure 6
Encoder output comparison with different sampling times.
(a)(b)By comparing the encoder performance of recording continuity, it shows that the encoder with 0.1 ms sampling time is better. Therefore, in this paper, the robot controller is based on position encoders with a sampling time of 0.1 ms sampling time.


## 5. Control Performance

In control processing, the hardware is based on the BECKHOFF TwinCAT 3 real-time platform, and the communication protocol is EtherCAT.In this section, the experimental test of the proposed controller follows the performance criteria shown in [6]. The criteria include the tests of step response, trajectory tracking without load, and payload verification. The experimental tests of control performance are based on the 6-DoF medical robot platform. As shown in Table 2, the control parameters for the six joints are listed in detail.Table 2
Control parameters of the six joints.
Joint654321kP,i0.20.21.21.23.13.1kI,i0.060.060.50.51.21.2kD,i0.010.010.10.10.230.23trisems685351575050tc,risems110tc,rise−trisetc,rise%38.2%51.8%53.6%48.2%54.4%54.5%


### 5.1. Joint Control Performance

To reduce the delay time of the dynamic response, in this part, this paper will focus on the rising time for each joint under the command of a sequence of step-square waves. The dynamic joint response can be recorded by TwinCAT 3, and then, the rising time based on the recorded curves can be detected.Based on the control proposed in the last section, the joint control performances are shown in Figures7–9.Figure 7
Joint control performance of Joint 6.Figure 8
Joint control performance of Joint 4.Figure 9
Joint control performance of Joint 1.In Figures7–9, all figures show that each joint control can achieve the goal with high precision and well dynamic response. More details are shown in Table 2. The rising time for each joint is 68 ms, 53 ms, 51 ms, 57 ms, 50 ms, and 50 ms, respectively.For comparison, a commercial controller was adopted to control this 6-DoF robot, and the rising time of joint response (tc,rise) was about 110 ms based on the commercial controller. Compared with the commercial controller, the controller proposed in this paper could reduce the rising time of joint response by almost more than 50% (see Table 2). Hence, the controller proposed in this paper realized low delay control and improved the dynamic response of control.


### 5.2. Task Space Tracking Performance

To test the tracking performance of the 6-DoF robot in the task space, a set of commanded velocities of the end effector is adopted as shown in Figure10.Figure 10
The commanded velocities of the end effector.In Figure10, the path planning for the commanded velocities follows three steps, speed up, constant speed, and slow down.Based on the commanded velocities of the end effector, the six joints of the robot will track the commanded velocities in the joint space. As shown in Figure11, it shows the tracking results of the joint velocities. For the ith joint, θ̇d,i is the commanded joint velocity, and θ̇i is the real joint velocity (i=1,2,⋯,6). Figure 11 shows that the six joints could follow the commanded velocities well.Figure 11
Tracking velocities of six joints.In Figure12, it shows the tracking error of the six joints. The tracking error is small and converging to zero.Figure 12
Tracking velocity errors of six joints.Therefore, based on the experimental results shown in Figures11 and 12, the controller shown in this paper could realize the good tracking performance of the 6-DoF robot in the task space.


### 5.3. Contact Space Tracking Performance

To test the tracking performance of the 6-DoF robot in the contact space, the test experiments include plate surface contact test and curved surface contact test (see Figure13). In both tests, the robot is expected to move along the surface with a stable contact force.Figure 13
Contact space test (plate surface and curved surface).In Figure14, it shows the trajectory of the contact force when the robot is required to move along the plate surface. The contact force is recorded by a six-dimensional force sensor. The commanded contact force is set as 5 N.Figure 14
Plate surface contact tracking performance.In Figure15, it shows the trajectory of the contact force when the robot is required to move along the curved surface. The commanded contact force is set as 10 N.Figure 15
Curved surface contact tracking performance.Both in Figures14 and 15, the robot could track the surface well. In particular, in the test of curved surface, the end of the robot could keep a stable contact force on the complex curved surface. The experimental results of the contact space tracking show the controller have well dynamic performance.


## 5.1. Joint Control Performance

To reduce the delay time of the dynamic response, in this part, this paper will focus on the rising time for each joint under the command of a sequence of step-square waves. The dynamic joint response can be recorded by TwinCAT 3, and then, the rising time based on the recorded curves can be detected.Based on the control proposed in the last section, the joint control performances are shown in Figures7–9.Figure 7
Joint control performance of Joint 6.Figure 8
Joint control performance of Joint 4.Figure 9
Joint control performance of Joint 1.In Figures7–9, all figures show that each joint control can achieve the goal with high precision and well dynamic response. More details are shown in Table 2. The rising time for each joint is 68 ms, 53 ms, 51 ms, 57 ms, 50 ms, and 50 ms, respectively.For comparison, a commercial controller was adopted to control this 6-DoF robot, and the rising time of joint response (tc,rise) was about 110 ms based on the commercial controller. Compared with the commercial controller, the controller proposed in this paper could reduce the rising time of joint response by almost more than 50% (see Table 2). Hence, the controller proposed in this paper realized low delay control and improved the dynamic response of control.


## 5.2. Task Space Tracking Performance

To test the tracking performance of the 6-DoF robot in the task space, a set of commanded velocities of the end effector is adopted as shown in Figure10.Figure 10
The commanded velocities of the end effector.In Figure10, the path planning for the commanded velocities follows three steps, speed up, constant speed, and slow down.Based on the commanded velocities of the end effector, the six joints of the robot will track the commanded velocities in the joint space. As shown in Figure11, it shows the tracking results of the joint velocities. For the ith joint, θ̇d,i is the commanded joint velocity, and θ̇i is the real joint velocity (i=1,2,⋯,6). Figure 11 shows that the six joints could follow the commanded velocities well.Figure 11
Tracking velocities of six joints.In Figure12, it shows the tracking error of the six joints. The tracking error is small and converging to zero.Figure 12
Tracking velocity errors of six joints.Therefore, based on the experimental results shown in Figures11 and 12, the controller shown in this paper could realize the good tracking performance of the 6-DoF robot in the task space.


## 5.3. Contact Space Tracking Performance

To test the tracking performance of the 6-DoF robot in the contact space, the test experiments include plate surface contact test and curved surface contact test (see Figure13). In both tests, the robot is expected to move along the surface with a stable contact force.Figure 13
Contact space test (plate surface and curved surface).In Figure14, it shows the trajectory of the contact force when the robot is required to move along the plate surface. The contact force is recorded by a six-dimensional force sensor. The commanded contact force is set as 5 N.Figure 14
Plate surface contact tracking performance.In Figure15, it shows the trajectory of the contact force when the robot is required to move along the curved surface. The commanded contact force is set as 10 N.Figure 15
Curved surface contact tracking performance.Both in Figures14 and 15, the robot could track the surface well. In particular, in the test of curved surface, the end of the robot could keep a stable contact force on the complex curved surface. The experimental results of the contact space tracking show the controller have well dynamic performance.


## 6. Conclusions

In this paper, a method for joint control in robot-assisted orthopedic surgery was proposed. Compared to traditional joint control, improved joint control includes PID, sliding mode control, and adaptive dynamic compensation as a module unit. The performance of the proposed joint control was tested on a six-DoF robot. The experimental results of the joint dynamic response under square waves show that the proposed control method has a much smaller rising time than the commercial controller product, which means better performance in high dynamic response for the robot. The experimental results of the tracking performance in the task space and contact space show that the robot could follow the commanded velocities well.In the near future, the proposed joint control method will be applied for real orthopedic surgery experiments. And further research will focus on improving human-machine collaboration based on the proposed control method.



---

*Source: 1412068-2022-03-08.xml*