Disturbance Elimination for theModular Joint Torque Sensor of a Collaborative Robot

,e ability to obtain accurate torque information and detect collision information is the key demand for collaborative robots. Given the highly integrated modular joint, the joint torque-sensing system is disturbed by other elements during online measurement, affecting the accuracy of measurement. For example, the torque ripple caused by the periodic deformation of the flexspline of the harmonic driver and the temperature drift due to the heating of motor are the two main factors affecting the measurement of the torque sensor. In this study, a torque sensor suitable for a modular joint is developed. Moreover, a strain gauge configuration based on a specified phase difference for torque ripple cancelation and a temperature compensation method based on the combination of the Wheatstone bridge and a nonlinear model are proposed. Finally, the performance of the developed sensor is experimentally evaluated.


Introduction
Collaborative robots can be remarkably applied in various industries, for example, medical treatment, 3C electronics, and public service [1,2]. To avoid injury from robots, the collision detection technology of robots has attracted extensive attention. is technology based on a visual sensor needs to collect and process a high volume of real-time data [3]. Collision detection based on a motor current should predict interference and assembly error model to accurately estimate torque [4]. To resolve these problems, many scholars have embedded a joint torque sensor into robot joints [5,6]. In addition, the method based on strain gauges to measure force or moment is more mature and reliable, and this method is favored by researchers [7,8].
At present, the harmonic drive is widely used in collaborative robots because of its high gear-reduction ratio and high torque ability in a compact geometry. During the operation of the harmonic driver, the elliptical wave generator facilitates the periodic deformation of the flexspline.
is process couples the output of the torque sensor embedded in the robot joint with the periodic noise, which is also known as torque ripple [9]. Taghirad designed a Kalman filter to compensate for the torque ripple [10]. However, this method needs to estimate the model of the torque ripple in advance. Jung adopted the order tracking method based on resampling to eliminate the torque ripple [11]. However, the resampling method is only applicable when the position changes. Considering that the torque ripple mainly originates from the deformation of the flexspline, Hashimoto balanced the torque ripple by pasting strain gauges on the flexspline and forming the Wheatstone bridge [12]. is method avoids numerous calculations and improves response speed, but strain gauges should be pasted on the bottom of the flexspline in a certain configuration. In addition, the torsional stiffness of the flexspline should also be known. To reduce the placement error of the strain gauges and torque ripple, an elastomer with mutually perpendicular spokes and pasted strain gauges has been designed by adding two signals from two sets of stain gauges to eliminate the torque ripple [13,14]. However, this method needs two sets of signal conditioning circuits.
During operation of the robot, the heat generated by the motor is easily transmitted to the torque sensor through the metal transmission shaft and metal flange.
is process creates a temperature drift in the output signal of the torque sensor.
e Wheatstone bridge is commonly used in the joint torque measurement with strain gauge [12,15]. However, when strain gauges are heated unevenly, this technique deteriorates the sensing performance. Francisco studied the temperature drift of a six-axis force torque sensor based on the strain gauge by assuming that the temperature drift of this sensor has a linear relationship with six-axis force. In this study, the calibration matrix and temperature drift coefficient of the sensor are estimated simultaneously using linear regression based on the least square method [16]. Sun modeled the temperature drift of a six-axis force torque sensor of a space manipulator by using the least square support vector machine and particle swarm optimization algorithm to optimize the parameters of the model [17]. However, the software compensation depends on the accuracy of the model. Moreover, the more accurate the model is, the more the calculation needed is, and this process introduces transmission delay. erefore, to balance the accuracy and delay of the sensor, hardware and software are combined to compensate for the temperature drift.
In this study, a joint torque sensor embedded in a modular joint, which includes a motor, a harmonic drive, a torque sensor, and an encoder, is proposed to mainly address how a robot obtains accurate torque-sensing ability. e main research contents are as follows. A torque ripple cancelation method, which combines a specially designed elastic body and the Wheatstone bridge in a special form, is proposed. us, the periodic disturbance from the harmonic drive can be compensated. In addition, the temperature compensation method based on the combined hardware and software is proposed. Another Wheatstone bridge is distributed symmetrically with respect to the first Wheatstone bridge to cancel the torque ripple. A nonlinear model is also proposed to further reduce the error from the temperature drift.
is paper is organized as follows. e design of the torque sensor and the theoretical analysis of the torque ripple cancelation, temperature compensation, and collision detection are discussed in Section 2. In Section 3, the experimental setups for the developed torque sensor are presented. e evaluation results of the torque ripple cancelation, the temperature drift compensation, and collision detection are addressed in Section 4. Finally, the conclusion is provided in Section 5.

Problem Statement.
A collaborative robot is a robot that can directly and physically interact with a human operator in a shared workspace. For example, a collaborative robot with surgery tool and several doctors perform an eye or orthopedic surgery together. For safety requirements, one of the most basic characteristics of a collaborative robot is the estimation of external force or collision detection. Industrial robots measure the external force by using a six-axis force torque sensor, which is only suitable for a force/torque acting on the robot end-effector. However, a torque sensor arranged on the robot joint can estimate the force acting on most areas of the robot. erefore, a joint torque sensor is one of the necessary hardware devices for a collaborative robot. To facilitate repair and reconfiguration, collaborative robots need modular joints, which connect adjacent links and integrate the drive, sensing, and control.
A modular joint unit usually consists of a motor, a harmonic drive, a joint torque sensor, a joint encoder, and other modules. e shaft of the motor is directly connected to the wave generator of the harmonic driver, while the joint torque sensor is connected to the flexspline through the connector. As shown in Figure 1, the periodic deformation of the flexspline propagates to the joint torque sensor through the connector. is process mixes the output of the joint torque sensor with the torque ripple. e motor is the main heat source while the modular joint is used. e heat will be transferred to the joint torque sensor through the harmonic drive and connector, causing the output of the joint torque sensor to drift, even if the external load of the torque sensor is constant. us, for accurate collision detection, the design of the sensor should cancel the torque ripple and the temperature drift. Figure 2, the elastic body of the sensor is designed as the spoke type; that is, the inner and outer rings are connected by spokes. e slit on the spoke makes the strain of the sensor equivalent to that of the spoke. Given the idle space outside the spoke, a signal processing circuit can be built in this space to make the sensor compact and thinner. In addition, four protective beams are added. When the sensor is overloaded, the protective beam will prevent irreversible damage to the sensor.

Design of Joint Torque Sensor. As shown in
Based on the proposed torque sensor design, the finite element method (FEM) is conducted using ANSYS. e maximum sensing torque is 70 Nm, and the maximum load that the torque sensor can endure is set to 180 Nm. e maximum strain is 0.003 mm as calculated from the design of the conditioning circuit. e 6061 aluminum alloy is selected to fabricate the sensor because of its small elastic coefficient and large yield strength. e coordination of the torque sensor is shown in Figure 3. e applied load is Mx � 180 Nm. e structural parameters of the spoke as calculated by FEM are shown in Table 1. e deformation of the body is illustrated in Figure 4. e analytical results are used to specify the location of the strain gauge. e mechanical strain of the torque sensor can be measured by using the strain gauge forming the Wheatstone bridge. However, the voltage signal of the Wheatstone bridge is too weak to collect. Hence, the weak electrical signal should be amplified and filtered. e analog signal is further converted into digital form to read the torque signal on the chip. In addition, a temperature-measuring circuit is installed to compensate for the temperature drift. A conditioning circuit board is designed and consists of an ADA4528 amplifier with a factor of 200, an RC low pass filter to cancel the noise signal, and an AD7790 with 16 bit buffered sigma-delta ADC to convert the analog signal to digital signal. e AD7790 transmits the digital signal to a microcontroller STM32F103T8 through the SPI communication protocol. e microcontroller can directly collect the temperature signal by its ADC. e schematic diagram of the sensor circuit is shown in Figure 5, and the developed torque sensor is displayed in Figure 6. Figure 7(a), for each revolution of the elliptical wave generator of the harmonic drive, the flexspline produces two cycles of deformation, resulting in the torque ripple depicted by curve A in Figure 7(b). As shown in Figure 7(b), the periodic interference can be eliminated by adding the torque ripple curve A to the other curve A with the same amplitude and frequency but with phase difference of π/2.

Torque Ripple Cancelation. As shown in
To cancel the torque ripple, four strain gauges R 1 -R 4 are mounted on the optimum location at both sides of the spoke to collect the strain signals (Figure 8(a)) and form the Wheatstone bridge (Figure 8(b)). e theoretical analysis is as follows.
When a clockwise torque T is applied to the sensor, the odd-numbered strain gauges are under tension, while the even-numbered strain gauges are under compression. Strains ε 1 and ε 2 measured by gauges R 1 and R 2 , respectively, can be expressed as follows: where ε t is the tensile strain caused by the applied torque and ε w is the tensile strain due to the deformation of the flexspline. To obtain the information of ε t , the difference between strains ε 1 and ε 2 is written as follows: where the difference ε ω − ε ω′ is assumed to be sinusoidal as explained by Hashimoto [12] and β is the rotational angle of the wave generator to the reference point.
To measure strain ε t and eliminate Ψ 0 sin(2β), another signal A as mentioned above should be obtained. Gauges R 3 and R 4 are on the spoke rotating at 90°from the position of R 1 and R 2 . Signal A can be obtained by the difference of strain ε 3 and ε 4 , which are measured by gauges R 3 and R 4 , respectively.
Equations (2) and (3) can be added to cancel the sinusoid component as follows: us, the Wheatstone bridge composed of R 1 , R 2 , R 3 , and R 4 can generate a voltage signal proportional to strain ε t .
where K is the strain coefficient of the gauges, and U i and U o represent the input and output voltages of the Wheatstone bridge.
If the bridge is subject to the same change in temperature, the strain due to temperature is canceled out. To minimize the sticking error and enhance the temperature

Temperature Compensation Method.
e Wheatstone bridge circuit, which is composed of eight strain gauges, can eliminate theoretically the effect of temperature. However, due to the distinct change in temperature of each strain gauge, accurate torque information is difficult to obtain if only the circuit is used. erefore, on the basis of hardware compensation, this study adopts software to compensate for the temperature drift. e specific method is to measure the elastic body temperature with a built-in thermistor. en, the experimental data are obtained to solve the temperature compensation model based on the least square method. e change in the temperature of the sensor can be measured by the thermistor pasted on the body of the sensor. e temperature-measuring circuit and the pasting position of the thermistor are shown in Figure 9.  According to Figure 9(a), the resistance of the thermistor can be calculated as follows: where R a is the voltage divider; R t is the thermistor; R b and C 1 constitute the RC low pass filter circuit; and V adc is the input voltage of the analog-to-digital converter.
In addition, the temperature of the thermistor related to the resistance of thermistor can be expressed as follows: where R nom is the nominal resistance of the thermistor at 25°C; B is the known parameter of the thermistor; T nom is the Kelvin temperature corresponding to 25°C; and T t is the measurement temperature described by the Kelvin temperature. Substituting R t as given in (6) into (7), the current temperature of the sensor can be easily calculated. e applied torque of the sensor related to the output voltage of the Wheatstone bridge can be expressed as follows: where k is the sensor sensitivity independent of temperature and b is the temperature drift that can be modeled as a second-degree polynomial related to temperature T as follows: Substituting (9) into (8), the output of the sensor can be presented as follows: When the applied torque of the sensor is 0, the temperature drift model of the sensor can be obtained as follows: To acquire an accurate torque information, parameters A 0 ′ , A 1 ′ , and A 2 ′ should be estimated. In this study, polynomial fitting is used to solve the parameters by using at least three sets of experimental data.

Collision Detection Method.
To reflect the comprehensive performance of the joint torque sensor, the proposed torque sensor is applied to the collision detection, which is one of the most typical applications of a collaborative robot. e schematic diagram of collision detection is shown in Figure 10. e dynamic of a robot system with n degrees of freedom can be modeled as follows: where θ, _ θ, and € θ ∈ R n are the vectors of the generalized joint coordinates, velocities, and acceleration, respectively; M(θ) ∈ R n×n is the joint-space inertia matrix; C(θ, _ θ) ∈ R n×n is the Coriolis and centripetal coupling matrix; G(θ) ∈ R n is the gravity loading; τ f ∈ R n is the friction force; τ m ∈ R n is the vector of generalized actuator force associated with the generalized coordinate θ; and τ c ∈ R n is the joint force due to the external torque.
Based on the robot dynamic characteristic that _ M(θ) − 2C(θ, _ θ) is a skew symmetric matrix, the following equation is obtained: To estimate the external torque, the generalized momentum of robot is modeled as follows:

Mathematical Problems in Engineering
Given the time derivative of p, and substituting (15) into (12) yields e observer about joint force τ c can be designed as follows: where Substituting (16) into (17) and then integrating (17), the observer r(t) with initial condition r(0) � 0 can be expressed as follows: e Laplace transform of (17) can be expressed as follows: Equation (19) is a first-order low pass filter. Hence, One of the basic characteristics of the first-order low pass filter is that high-frequency noise signal will not pass, and a greater value of K O can obtain a faster step response. is good characteristic makes the generalized momentum observer a good virtual force sensor, which is used to measure the external force acting on the robot.
Given the errors of dynamic modeling and friction identification, r(t) cannot be accurately calculated. us, the estimation r(t) is used in this experiment [18].
where p(t) is the estimated robot-generalized momentum at time t ≥ 0; τ m is the measured torque; τ f is the friction torque; the matrix C T (θ, _ θ) comprises the Coriolis and centrifugal terms; and g(θ) is the gravity vector. e collision of a robot is detected by the observer algorithm by setting the collision detection threshold as follows: where Υ ∈ R n is the vector of the collision detection threshold. In practical application, the threshold cannot be too small. Otherwise, misjudgment will occur. If the threshold is too high, the robot becomes less sensitive to collision. e threshold is minimized as error and noise are considered.

Calibration Setup.
e dynamic calibration of the joint torque sensor is performed on the developed automatic calibration system, which includes a dynamic calibration platform and an application program based on LabVIEW. As shown in Figure 11, the dynamic calibration platform involves a magnetic powder brake, a slip-ring, a reference sensor (TS11-200-B, INTERFACE), the developed sensor, the developed modular joint, a potentiometer, a data acquisition device, an amplifier, a power supply, and a connecting part. e developed sensor is connected to the reference sensor by the connecting part. e application program collects the torque signal of the reference sensor through the data acquisition device and the output voltage signal and temperature signal of the developed sensor via RS485. us, the real-time drawing function of the signals is realized.
During calibration, the modular joint moves at a constant speed, and the brake force of the magnetic powder brake is controlled by adjusting the output voltage of the potentiometer to obtain the desired applied torque read from the reference torque. In this setup, a torque interval from 0 Nm to 70 Nm is applied, which is equal to the peak torque of the motor magnified by the harmonic drive.

Collision Detection
Setup. An experiment system is used to examine the collision detection method (Figure 12). e system consists of the developed modular joint, the developed torque sensor, a motor driver (Golo Solo Whistle series, Elmo), a motor controller (Platinum Maestro, Elmo), and a one-link arm. e dynamics of the arm can be modeled as follows.  Mathematical Problems in Engineering τ � ml 2 + J € q + mgl sin(q), (23) where q and € q represent the arm angle and acceleration, respectively; m is the arm quality; l is the distance from the center of mass to the axis of the joint; J is the arm inertial; and τ is the measured torque from the torque sensor. e identified parameters of the dynamic model are listed in Table 2.

Evaluation of the Torque Ripple Cancelation.
Two of the developed sensors are needed to verify the effectiveness of the torque ripple cancelation method. One sensor adopts the strain gauge configuration as shown in Figure 13, while the other sensor adopts the strain gauge configuration as shown in Figure 8. e former is the type without torque ripple cancelation, and the latter has torque ripple cancelation. e modular joint is equipped with these two sensors. en, the modular joint is rotated at a velocity of 35.16°/s without load. e sensor outputs of these two configurations are collected   Figure 14(a) shows that the voltage curve representing the torque ripple is fluctuating. Figure 14(b) demonstrates that the curve of the torque ripple becomes flatter, and its amplitude is almost equal to the temperature drift. In addition, Figure 15 shows the FFT plot of both torque signals. Figure 15(a) shows two peaks at 19.76 Hz and at 9.89 Hz, which correspond to the torque ripple. Figure 15(b) displays the FFT plot of the signal with the torque ripple cancelation. No peaks are observed at 19.76 Hz and 9.89 Hz. erefore, the torque ripple is clearly reduced. is method does not need any additional software filtering algorithm and will not cause delay of the torque signal.

Evaluation of Temperature Compensation.
e temperature drift of the sensor is caused by the increase in temperature rather than a drop in temperature [16]. erefore, in this paper, the hysteresis of the temperature drift is ignored, and only the case of temperature rise is considered. To verify the temperature compensation method, the temperature of the sensor is between 20°C and 45°C with an increment of 5°C. us, the output of the sensor varies with the change in temperature. e output data are collected to fit the temperature compensation model by using the method described in Section 2.4. Figure 16 displays the relationship between the temperature and the output voltage of the sensor. e measured temperature and the voltage showed a nonlinear relationship. In this study, a second-degree polynomial curve is applied to fit the nonlinear curve. e fit equation can be expressed as follows: To evaluate the effectiveness of the temperature compensation method, the sensor output before and after the compensation is collected and compared. As shown in Figure 17, the output torque of the sensor increases with temperature before the compensation, and the maximum value is 0.38 Nm. After the compensation, the output torque decreases apparently, and the maximum error is 0.08 Nm.

Calibration.
During calibration, the modular joint moves at 2°/s in a counterclockwise direction, and the brake force of the magnetic powder brake is controlled to apply the desired torque that ranges between 0 Nm and 70 Nm with an increment of 5 Nm on the reference and developed sensors. e output data are collected from the reference and developed sensors, respectively. As shown in Figure 18, the xaxis corresponds to the voltage data from the developed sensor, and the y-axis corresponds to the applied torque measured by the reference torque sensor. e measured voltage and the applied torque show a linear relationship. In this study, a first-degree polynomial curve is applied to fit the linear curve. e fit equation can be expressed as follows: (25) erefore, the nonlinear error of the torque sensor is 0.878%, and the hysteresis is 0.903%. e sensitivity is 0.0627 Nm · (mV) − 1 , and the temperature drift is −34.8 mV.
e performance of the developed torque sensor is compared with that of the commercialized torque sensor M2210C1 (Sunrise Instruments). e comparative results are provided in Table 3. M2210C1 shows better performance than the developed sensor. However, because the output signal of M2210C1 is an analog signal, high-frequency noise can be mixed with this signal. In addition, the developed sensor is lighter than M2210C1 and can be calibrated online with the modular joint to improve sensing accuracy.

Evaluation of Collision Detection.
To verify intuitively the effectiveness of the collision detection method described in Section 2.5, the experimental setup shown in Figure 19 is adopted. An egg is erected between the one-link arm and the obstacle. en, the arm is controlled to collide horizontally with the egg. e obstacle limits the displacement of the egg after impact. When the impact torque is detected, the movement of the arm stops. In this experiment, the identified dynamic parameters (Table 2) of the arm are used for the observer of the external force, and the observer gain coefficient K o is equal to 100. e speed signal is filtered, and the sampling frequency is set to 100 Hz. To set a reasonable collision detection threshold, the arm moves in different directions at distinct speeds without an external force acting on it. e estimated torque of the observer satisfies |r(0)| < 0.0255 Nm. us, the collision detection threshold is set to 0.03 Nm. e movement velocity of the arm is between 30°(s) and 60°(s). Figure 20 displays the estimated impact torque with no broken egg. ese phenomena show that the designed joint torque sensor can effectively detect collision with short delay.

Conclusion and Future Work
In this paper, a torque sensor sensing technique is introduced for the developed modular joint. Based on theoretical and experimental research, the torque ripple is clearly reduced by using a spoke-type sensor body and a special strain gauge configuration. In addition, the temperature drift is compensated by using the combination of the Wheatstone bridge and the proposed temperature drift model. e performance of the developed torque sensor is compared with that of a commercial sensor. e commercial torque sensor, namely, M2210C1, shows better resolution in its torque-sensing ability. However, the output voltage of this sensor is an analog signal, and, compared with the digital output, electromagnetic noise can be easily introduced to the analog signal. In addition, the developed sensor is lighter than M2210C1 and can be calibrated online with the modular joint to overcome the sensing error caused by assembly. Furthermore, the developed modular joint and the proposed torque sensor show good collision detection performance.
In this study, only a modular joint is employed to assess the torque ripple cancelation and the temperature drift compensation. A collaborative robot with multiple degrees of freedom will be evaluated in future studies.

Data Availability
As the project will not be finished until May 2022 and we have confidentiality agreement with the State Key Laboratory of Robotics and System, the data could not be released so far. For any information about the article, please contact us via zhanghe0451@hit.edu.cn.

Conflicts of Interest
e authors declare that there are no conflicts of interest regarding the publication of this paper.