A Terminal Residual Vibration Suppression Method of A Robot Based on Joint Trajectory Optimization

Vibration problems have become one of the most important factors affecting robot performance. To this end, a terminal residual vibration suppression method based on joint trajectory optimization is proposed to improve the accuracy and stability of robot motion. Firstly, based on the characteristics of the friction nonlinearity due to joint coupling and physical feasibility of dynamic parameters, a semidefinite programming method is used to identify dynamic parameters with actual physical meaning, thereby obtaining an accurate dynamic model. Then, based on the result of the residual vibration time domain analysis, a joint trajectory optimization model with the goal of minimizing joint tracking error is established. The Chebyshev collocation method is used to discretize the optimization model. The dynamic model is used as the optimization constraint, and barycentric interpolation is used to obtain the optimized joint motion trajectory. Finally, industrial robot experiments prove that the vibration suppression method proposed in this article can reduce the maximum acceleration amplitude of residual vibration by 62% and the vibration duration by 71%. Compared with the input shaping method, the method proposed in this paper can reduce the terminal residual vibration more effectively and ensure the consistency of running time and trajectory.

Keywords:

industrial robot

;

parameter identification

;

vibration suppression

;

optimal trajectory

;

Chebyshev collocation

Subject:

Engineering - Industrial and Manufacturing Engineering

1. Introduction

With the development of science and technology and the rise of industrial automation, industrial robots perform tasks through efficient and precise movements, improving productivity, reducing costs, and creating a safer working environment for humans [1,2,3]. The flexible characteristics of industrial robot joint transmission parts like the RV reducers and gears reduce the overall stiffness of the robot, making it have a more complex vibration mode and easier to vibrate during and after the movement [4,5]. Such vibration problems have become one of the most important factors affecting the performance and stability of robots. Robot vibration suppression technology reduces or eliminates robot vibration through advanced control strategies and design methods, thereby improving motion accuracy and stability.

With an accurate system model, motion profiles or feedforward control can be generated based on optimal trajectory planning to minimize overshoot and residual vibration. Based on the chaotic particle swarm optimization algorithm, the trajectory interpolation parameters can be optimized with the minimum vibrational deformation of the flexible end as the objective function [6]. In literature [7], the dynamic equation of the flexible curve connecting rod was derived by using the absolute nodal coordinate formula, and the optimal trajectory method was used to generate the trajectory with the least vibration of the flexible curve connecting rod. Based on the optimal control theory, the trajectory planning problem of suppressing the residual vibration of the robot was transformed into the optimal control performance problem, and the Fourier series was used to fit the discrete optimal trajectory [8]. Literature [9] proposed a torque feedforward damping strategy based on the chaotic regression tree dynamics model to improve the motion accuracy of the robot in the process of low-speed motion and suppress the vibration of the robot. In order to achieve fast position control, dynamic internal torque compensation based on dynamic model and robust continuous path following control with vibration suppression control were proposed in literature [10]. Literature [11] adopted a fully compensated feedforward torque control method based on the dynamic model, and compared with other feedforward methods, the robot has the fastest response speed, the lowest joint trajectory tracking error and jitter. However, the above methods have high requirements for the model and parameter accuracy of the system, otherwise the interference caused by the uncertain disturbance inside the robot will affect the algorithm control effect.

If an accurate model is not available but the states associated with elastic vibrations can be measured or observed, singular perturbations [12,13] and nonlinear feedback control [14,15] can be implemented to accommodate unmodeled dynamics and perturbations. Iterative learning control is another option to solve these problems, and optimal feedforward control can be implemented through learning when robots perform the same tasks repeatedly [16,17]. Compared with the above methods, the input shaping method can effectively minimize overshoot and residual vibration, and does not require complex dynamic models, no direct measurement of elastic vibrations for online feedback, and no need for repetitive tasks. However, one disadvantage of the use of input shaping in industrial robots is the time delay, which can slow down the overall task for applications with fast stationary to stationary motion such as spot welding, handling, etc. Literature [18,19] proposed an improved zero-delay input shaping so that no delay was introduced. However, this kind of shaping algorithm depends on the vibration frequency parameter of the robot body, and the frequency change in different postures of the robot will affect the shaping effect. In addition, input shaping may change the original motion trajectory, and for applications with high trajectory accuracy requirements such as arc welding and gluing, changing the motion trajectory will reduce the quality of the work.

In order to solve the above problems, this paper proposes a terminal residual vibration suppression method based on joint trajectory optimization. Firstly, the physical feasibility dynamic parameters and nonlinear joint friction parameters are identified, then the optimal trajectory is obtained with the minimum joint tracking error as the optimization goal, and finally the effectiveness of the proposed algorithm is proved by experiments.

2. Identification of Dynamic Parameters Based on Physical Feasibility Constraints

Due to the complexity of the robot components and assembly errors, it is difficult to know the robot dynamics accurately. However, it was found that the dynamic characteristics of the robot are a linear function of its inertial parameters [20], so the problem of obtaining the inertial parameters of the robot can be transformed into a system of linear equations. First, the robot dynamics equation is rewritten into a linear parametric form, as shown in (1)

τ = Y (q, \dot{q}, \ddot{q}) β

(1)

where

β \in ℝ^{N_{b}}

is the reorganization parameter vector which is called minimum inertia parameter,

Y (q, \dot{q}, \ddot{q}) \in ℝ^{n \times N_{b}}

is the full-rank observation matrix obtained after reorganization. Afterwards, controlling robot by joint excitation trajectory and collecting the torque value of each joint in the process to obtain a group of test data, formula (2) is obtained according to (1)

Γ = W β + ρ

(2)

where

W = {[Y {(q (t_{1}), \dot{q} (t_{1}), \ddot{q} (t_{1}))}_{n \times N_{b}}, \dots, Y {(q (t_{M}), \dot{q} (t_{M}), \ddot{q} (t_{M}))}_{n \times N_{b}}]}^{T}

is the observation matrix,

ρ

is the observation error due to various reasons,

Γ = {[\begin{matrix} τ {(t_{1})}^{T} & τ {(t_{2})}^{T} & \dots & τ {(t_{M})}^{T} \end{matrix}]}^{T}

is the joint torque value corresponding to the test data. Finally, according to the least squares method, the minimum inertia parameter estimation vector

\hat{β}

can be obtained.

Constructing an accurate friction model is an important part of improving the accuracy of the dynamic model, and it is difficult for a single friction model to fully fit the diverse joint features. For coupling joints of an industrial robot, the friction between two joints interacting with each other produce characteristics that differ from the standard friction model. Therefore, the friction model

f_{j}

of the coupling joint j is designed as equation (3)

f_{j} = \{\begin{cases} F c_{j - 1} \cdot sign ({\dot{q}}_{j}) + F v_{j - 1} \cdot {\dot{q}}_{j}, {\dot{q}}_{s} \leq |{\dot{q}}_{j}| < {\dot{q}}_{l} \\ F c_{j - 2} \cdot sign ({\dot{q}}_{j}) + F v_{j - 2} \cdot {\dot{q}}_{j}, |{\dot{q}}_{j}| \geq {\dot{q}}_{l} \end{cases}

(3)

where

{\dot{q}}_{s}

and

{\dot{q}}_{l}

is pre-identify parameters for the friction model.

F c_{j - m}

and

F v_{j - n}

are the parameters to be identified with minimum inertial parameters synchronously.

The minimum inertial parameters calculated by the least squares method can only identify linear combinations of parameters, and cannot assert the physical feasibility directly. Therefore, it is necessary to add feasibility constraints to the calculation of dynamic parameter identification to obtain the standard parameter form that satisfies the definition of physics. For the connecting rod k, the parameter

δ_{k}

to be identified is defined as

δ_{k} = [L_{k, x x}, L_{k, x y}, L_{k, x z}, L_{k, y y}, L_{k, y z}, L_{k, z z}, l_{k, x}, l_{k, y}, l_{k, z}, m_{k}]

(4)

For a 6-joint industrial robot, the mass of connecting rod k must be positive, and the inertial tensor is symmetrical and positive definite. The set of available physical feasibility constraints for the robot is expressed as

Ω = \{δ \in ℝ^{n} : m_{k} > 0, L_{k} - \frac{1}{m_{k}} S {(l_{k})}^{T} S (l_{k}) ≻ 0 | k = 1, \dots, 6\}

(5)

where

L_{k}

is the inertial tensor of the connecting rod k with respect to the coordinate system of the connecting rod,

l_{k}

is the first moment of the vector of inertia,

S (\cdot)

is a partial symmetric matrix operator. Combined with the parameters of the friction model

f_{p, i}

of each joint, the linear matrix inequality of the physical feasibility dynamic parameters is obtained as

D (δ) = d i a g (D (δ_{1}), \dots, D (δ_{6}), f_{p, 1}, \dots, f_{p, 6}) ≻ 0

(6)

Since there is a one-to-one mapping relationship

G

between the minimum inertia parameters

β

, the independent terms

δ_{d} \in δ

in the parameters to be identified, and the linkage dynamics parameters [21], the physical feasibility constraints can be transformed into the constraints of the minimum inertia parameters and independent parameters, as shown in (7)

D_{β} (β, δ_{d}) = D (δ) = D (G^{- 1} (β, δ_{d}))

(7)

u

is defined as the distance of the actual and identified values of the minimum inertial parameters as shown in (8)

u = {‖Γ - W β‖}^{2} = {(Γ - W β)}^{T} (Γ - W β)

(8)

Convert (8) into a linear matrix inequality form as (9)

U_{ω} (u, β) = [\begin{matrix} u & {(Γ - W β)}^{T} \\ Γ - W β & 1 \end{matrix}] \geq 0

(9)

In summary, the problem of solving the dynamic parameters based on the constraints of physical feasibility can be expressed as the following form of SDP:

\min_{(u, β, δ_{d})} u

(10)

\begin{matrix} s . t . & F (u, β, δ_{d}) \geq 0 \end{matrix}

(11)

where, the linear matrix inequality constraints are defined as (12)

F (u, β, δ_{d}) = [\begin{matrix} U_{ω} (u, β) & 0 \\ 0 & D_{β} (u, β) \end{matrix}]

(12)

For the optimization problem described in (10), (11) and (12), the optimal solution

u^{*}

is the sum of the identification errors under constraints, and the standard parameters

δ^{*}

of robot dynamics satisfying the physical feasibility constraints can be calculated from the mapping of the

δ_{d} ​^{*}

and

β^{*}

3. Residual Vibration Suppression Based on the Optimal Trajectory Principle

Unlike the conventional position motion of the robot, the residual vibration is characterized by a small oscillation with the position at the end of the trajectory as the equilibrium point. Bringing the joint vibration response into the forward kinematics model of the robot, it can be seen that the wrist position of the robot during residual vibration is

\{\begin{cases} p_{x e} = \sum_{p = 1}^{N} E_{p} \cos (ω_{p} t - ϕ_{p}) \\ p_{y e} = \sum_{p = 1}^{N} F_{p} \cos (ω_{p} t - ϕ_{p}) \\ p_{z e} = \sum_{p = 1}^{N} G_{p} \cos (ω_{p} t - ϕ_{p}) \end{cases}

(13)

where

E_{p}

F_{p}

and

G_{p}

is the amplitude of item p。The position error of the robot

P_{e} (t)

in cartesian space is a function of the joint position error and velocity error at the end time. Therefore, the problem of reducing residual vibration can be transformed into a problem of reducing the position and velocity error at the end time.

On the basis of the initial value of the trajectory, the optimal trajectory problem can be obtained by setting up objective functions and constraints to meet the requirements [22]. The optimal trajectory algorithm designed in this paper includes three steps: initial trajectory discretization, establishment and solution of objective function and constraints, and barycentric interpolation.

3.1. Initial Trajectory Discretization

According to the robot kinematic model, due to the nonlinear mapping of the terminal pose and the joint angle, the acceleration discontinuity or abrupt change will still occur in the joint space, so the optimization calculation will be carried out in the joint space. For cartesian space trajectory

P (t)

0 \leq t \leq t_{f}

, the angle of each joint in each control cycle is

q_{p, i} (t)

, on which Chebyshev collocation is performed as shown in (14)

q_{p, i} (T_{k}) = q_{p, i} (t_{f} [\cos (k π / N) + 1] / 2), k = 0, \dots, N

(14)

where

q_{p, i} (T_{0})

and

q_{p, i} (T_{N})

are the joint values corresponding to the initial and ending positions of the trajectory respectively.

One of the advantages of using the polynomial coordination method is that the differential matrix D can be used to derive the variables on the nodes quickly and accurately, so the differential of the position and torque of each joint are shown in (15)

\{\begin{cases} d q_{p, i} (T_{k}) / d T = 2 D \cdot q_{p, i} (T_{k}) / t_{f} \\ d τ_{p, i} (T_{k}) / d T = 2 D \cdot τ_{p, i} (T_{k}) / t_{f} \end{cases}

(15)

3.2. Objective Functions and Constraints

Define the position and velocity of each joint as the optimal problem state variables, and the joint torque as the control variable, as shown in (16)

\{\begin{cases} x (T_{k}) = {[q (T_{k}), \dot{q} (T_{k})]}^{T} \\ u (T_{k}) = τ (T_{k}) \end{cases}

(16)

Under the premise that the tracking performance of the control system is guaranteed, the problem of minimizing the position and speed error of the whole process and the start and stop points can be further simplified to the minimum acceleration change rate during motion, so the discretized optimization objective function is obtained as follows

J = \sum_{k = 1}^{N} \dot{u} {(T_{k})}^{T} W_{R} \dot{u} (T_{k})

(17)

where

W_{R}

is the weighted diagonal matrix. Theoretically, the greater the inertia, the greater the joint weight is.

The dynamic parameters identified by (10)-(12) can establish more accurate dynamic constraints for each joint, as shown in (18)

u (T_{k}) = DYN (x (T_{k}), δ^{*})

(18)

In addition, the position and velocity of the start and end moments of each joint are used as equation constraints, and the position limit, velocity limit, and acceleration limit of each joint are used as inequality constraints at nodes to ensure that the robot starts and stops running. After the above discretization and design of the optimization objective function, the problem of the minimum error of position and velocity at the end point has been transformed into a typical nonlinear programming (NLP) problem with constraints. The algorithm based on the gradient descent principle can be used to solve the optimal control quantity

u^{*} (T_{k})

and state quantity

x^{*} (T_{k})

at the node.

3.3. Barycentric Interpolation

Since the calculated optimal state quantity is the value at each node after discretization, it is necessary to select an interpolation algorithm to convert it into the joint position value of each control cycle. The node-based polynomial fitting is achieved by barycentric interpolation [23], which can be expressed as a linear combination of Lagrange polynomials, and the optimized angles of each joint are obtained as shown in (19)

\hat{q} (t) = \sum_{j = 0}^{N} q^{*} (T_{j}) l_{j} (t)

(19)

where

l_{j} (t)

is the j-th Lagrange polynomial, defined as (20)

l_{j} (t) = \prod_{k = 0}^{N} (t - T_{k}) \frac{v_{j}}{t - T_{j}}

(20)

where

v_{j}

is the imputation weight corresponding to node j. For node-based polynomial interpolation, the error of the optimized trajectory and the original trajectory at the node is 0, and the error between the nodes can be obtained by (21)

ε (t) = P (t) - KINE (\hat{q} (t))

(21)

Based on the above calculations, the motion trajectory with the same number of interpolation points as the pre-optimization trajectory is obtained again, which not only ensures that the optimized start-stop position is the same as the original trajectory, but also ensures the consistency between the optimized running trajectory and the original trajectory. Control the joints of the robot to complete the movement according to the optimized trajectory, so as to reduce the amplitude and duration of residual vibration.

4. Experimental Verification and Analysis of Results

The industrial robot T12B is selected for experimental analysis, and the inertial sensor is selected for vibration testing. The parameters are shown in Table 1. The experiment is divided into two steps, the dynamic parameters are identified firstly, and then the residual vibration suppression experiment is carried out based on the identification results.

4.1. Identification of Dynamic Parameters

The excitation trajectory based on the Fourier series function [24] is selected to control the robot motion, the joint position and torque information are collected, and the dynamic parameters are calculated according to the identification algorithm. Then, the verification trajectory different from the excitation trajectory is selected, the actual torque of each joint during the movement is recorded, and the theoretical torque value is calculated according to the identification parameters and the difference between the two torque is compared to verify the correctness and accuracy of the identification results.

The minimum inertial parameters without considering the constraints of physical feasibility are used, and the dynamic parameter identification results are calculated by the least squares method. The actual torque of each joint and the theoretical torque based on the identified parameters are plotted as shown in Figure 1. It can be seen from the figure that the theoretical torque and the actual torque have a large spike protrusion when the velocity direction changes, and there is always a certain range of error in the constant velocity section.

According to the coupling characteristics of the T12B robot and the unified identification method of joint friction, the friction model such as equation (3) is selected, and the friction model is included in the identification parameter set. The same excitation trajectory is selected, and the test data is substituted into equations (10)-(12) to calculate the kinetic parameters that meet the constraints of physical feasibility. The recalculated kinetic parameters are shown in Table 2, and the identified friction parameters are shown in Table 3.

The parameters of Table 2 are brought into the dynamic formula, and the friction of the joint is calculated according to the friction parameters in Table 3. The actual output torque of each joint and the theoretical torque based on the identified parameters are plotted as shown in Figure 2. Compared with Figure 1, it can be seen that the peak protrusion of the theoretical and actual torque is significantly reduced when the velocity direction changes, and the accuracy in the uniform velocity section is significantly improved, especially the torque errors of joints 3, 4 and 6 are improved significantly.

The root mean square error (RMS) of the theoretical torque and the actual torque of the identification model are shown in Table 4. According to the RMS results, the theoretical value of the torque in the whole process is closer to the actual torque value identified by the constraint-based inertia parameters. Compared with the identification results of the unconstrained and frictionless model, the results of the 4, 5 and 6 joints proposed in this paper are improved by about 80% compared with the original algorithm, which shows that the algorithm has a significant effect on coupling joints and friction-sensitive joints.

4.2. Verification of the Performance of Vibration Suppression

As shown in Figure 3, the robot moves in a straight line from position P1 to position P2 with a linear speed of 200mm/s. P1 and P2 are (590,0,294) and (1317,0,294) respectively under the base coordinate, and the unit is mm. Inertial sensor is installed at the flange to measure vibration during motion.

The experimental trajectory is the linear motion in cartesian space with no displacement in the Y-axis and Z-axis directions. The velocity in the X-axis direction is an S-shaped curve, which ensures a smooth velocity in cartesian space. From the kinematic model, it can be seen that the X-axis direction movement is mainly generated by the linkage of joints 2, 3 and 5, as shown in Figure 4.

However, due to the nonlinearity of the kinematic inverse solution, the above-mentioned joints produce a large velocity step at the start-stop point. In particular, in the deceleration stage of joint 3 at the stop point, the joint acceleration produces a peak value of 0.012, which is about 4 times of the peak acceleration value of the initial stage. The sudden change in acceleration of the deceleration section leads to a large tracking error, which causes residual vibration at the end of the robot.

The acceleration curve in the Z direction of the terminal is obtained by the inertial sensor, as shown in Figure 5. As can be seen from the figure, the vibration with an amplitude of less than 1 in the Z direction at the beginning of the motion and quickly converges to less than 0.5 with the motion. In the stop deceleration phase, the end amplitude is about 3 times that of the starting segment due to the abrupt change in acceleration, and a significant damping oscillation is generated.

According to the optimization model established in this paper, the kinetic parameters identified in Table 1 are brought into the dynamic constraints, the number of collocation nodes is selected as N = 12, the threshold of the number of iterations is 10, and the solution time is 0.2 seconds, and the motion curve of the optimized joint is obtained as shown in Figure 6.

After optimization, the start and stop points of the position curve of each joint are the same as those of the original curve, and the running time is the same. From equation (21), it can be seen that there is a maximum error of 0.5mm between the trajectory and the original trajectory during the process, which ensures the consistency of the running trajectory. The acceleration amplitude of joint 2 and joint 3 in the stop phase is about 0.5 times that of the original trajectory, and the jerk amplitude is basically the same as that of the original trajectory.

After optimization, the vibration at the end of the robot during operation is re-measured, and there is no visible vibration at the end of the entire process. The inertial sensor data in the stop stage of the robot is obtained and another curve is drawn by using the joint input shaping method as shown in Figure 7.

As can be seen from the figure, the maximum amplitude of the original vibration acceleration curve is 2.71, and the amplitude converges to less than 0.3 after 1.58s. After optimization, the maximum amplitude of the curve is 1.04, the amplitude converges to less than 0.3 after 0.46 seconds, the vibration stops completely at 0.7 seconds, the maximum amplitude decreases by 61.62%, and the vibration duration decreases by 70.89%. The input shaping vibration curve has a significant delay compared with the original curve with the maximum amplitude of 1.15 at 0.51 s. The maximum amplitude converges to within 0.3 after 0.69s, but there is still a small vibration after that. The amplitude converges to within 0.1 at 1.64 seconds. From the above analysis, it can be seen that compared with the input shaping method, the proposed method can reduce the residual vibration more effectively.

5. Conclusions

In this paper, a terminal vibration suppression method based on joint trajectory optimization is proposed. This method is based on the identification results of dynamic parameters with physical feasibility constraints, and takes the joint position and velocity tracking difference as the optimization goals. The trajectory obtained by optimization reduces the terminal vibration acceleration amplitude and convergence time, and ensures the consistency between the running trajectory and the original trajectory. The experimental results show that compared with the unconstrained least squares method, the torque error is significantly reduced at the joint velocity reversal, and the RMS of the coupling joint torque is reduced by 82.67% at most. Based on the identification results as dynamic constraint parameters, the maximum acceleration amplitude can be reduced by 61.62% and the vibration duration by 70.89%.

Author Contributions

Methodology, L.L. and C.W.; Software, L.L. and S.L.; Validation, L.L. and C.W.; Writing—review and editing, L.L. and S.L.. All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by the National Key Research and Development Plan: Heavy Duty Industrial Robot Development and Application (2023YFB4705102).

Conflicts of Interest

Authors Liang Liang, Shichang Liu, were employed by the company SIASUN Robot & Automation Co., Ltd. The remaining authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

References

Bluemel, S.; Bastick, S.; Staehr, R. Robot based remote laser cutting of three-dimensional automotive composite parts with thicknesses up to 5mm. Procedia CIRP 2018, 74: 417-420. [CrossRef]
Tran, C. C.; Lin, C. Y. An intelligent path planning of welding robot based on multisensor interaction. IEEE Sensors J. 2023, 23(8): 8591-8604. [CrossRef]
Liu, Y.; Zi, B.; Wang, Z; et al. Research Progress and Trend of Key Technology of Intelligent Spraying Robot. J. Mech. Eng. 2022, 58(7): 53-74.
Shabana, A. A.; Bai, Z. Actuation and motion control of flexible robots: small deformation problem. J. Mech. Robot. 2022, 14(1): 011002. [CrossRef]
Yan, Y.; Guo, Y.; Liu, X. Tooth root crack detection of planet gear in industrial robot RV reducer. Meas. Control 2023, 56(9-10): 1720-1731.
Long, T.; Li, E.; Yang, G.; et al. Trajectory planning of vibration suppression for hybrid structure flexible manipulator based on PSO non-uniform spline interpolation. J. Intell. Fuzzy Syst. 2018, 33(6): 978-988. [CrossRef]
Zhao, L.; Wang, H.; Chen, W. Optimal trajectory planning for manipulators with flexible curved links. Intelligent Autonomous Systems 14, Shanghai, China, 3 July 2016; 1013-1025.
Chen, J. Dynamic performance-oriented industrial robot control technology research. PHD thesis, Harbin Institute of Technology, Harbin, 2015.
Jia, B.; Chen, L.; Zhang, L.; et al. Vibration suppression of welding robot based on chaos-regression tree dynamic model. Nonlinear Dyn. 2024, 1-15. [CrossRef]
Bai, K.; Luo, M.; Jiang, G. Research of the torque compensation method for the vibration suppression of the industrial robot. IEEE International Conference on Robotics and Biomimetics, Zhuhai, China, 6 December 2015; 2575-2579.
Zhang, T.; Hong, L.; Qiang, K. Real-time feedforward torque control of an industrial robot based on the dynamics model. Univ. Politeh. Buchar. Sci. Bull., D, Mech. Eng. 2020, 82(1): 3-18.
Zheng, K.; Zhang, Q.; Zeng, S. Trajectory control and vibration suppression of rigid-flexible parallel robot based on singular perturbation method. Asian J. Control 2022, 24(6): 3006-3021.
Subudhi, B.; Morris, A. S. Singular perturbation approach to trajectory tracking of flexible robot with joint elasticity. Int. J. Syst. Sci. 2003, 34(3): 167-179.
Rigatos, G.; Abbaszadeh, M. Nonlinear optimal control for multi-DOF robotic manipulators with flexible joints. Optim. Control Appl. Methods 2021, 42(6): 1708-1733.
Alam, W.; Mehmood, A.; Ali, K; et al. Nonlinear control of a flexible joint robotic manipulator with experimental validation. Stroj. Vestn., J. Mech. Eng. 2018, 64(1): 47-55.
Chen, W.; Tomizuka, M. Dual-stage iterative learning control for MIMO mismatched system with application to robots with joint elasticity. IEEE Trans. Control Syst. Technol. 2013, 22(4): 1350-1361. [CrossRef]
Wang, Z.; Zhou, R.; Hu, C.; et al. Online iterative learning compensation method based on model prediction for trajectory tracking control systems. IEEE Trans. Ind. Inform. 2021, 18(1): 415-425. [CrossRef]
Zhao, Y.; Chen, W.; Tang, T. Zero time delay input shaping for smooth settling of industrial robots. IEEE International Conference on Automation Science and Engineering, Fort Worth, USA, 17 November 2016; 620-625.
Zhao, Y; Tomizuka, M. Modified zero time delay input shaping for industrial robot with flexibility. Dynamic Systems and Control Conference, Tysons, USA, 11 October 2017; 58295: V003T22A003.
Han, Y.; Wu, J.; Liu, C.; et al. An iterative approach for accurate dynamic model identification of industrial robots. IEEE Trans. Robot. 2020, 36(5): 1577-1594.
Sousa, C. D.; Cortesao, R. Physical feasibility of robot base inertial parameter identification: A linear matrix inequality approach. Int. J. Rob. Res. 2014, 33(6): 931-944.
Kelly, M. An introduction to trajectory optimization: How to do your own direct collocation. SIAM Rev. 2017, 59(4): 849-904.
Berrut, J. P.; Trefethen, L. N. Barycentric lagrange interpolation. SIAM Rev. 2004, 46(3): 501-517.
Swevers, J.; Verdonck, W.; De, S. J. Dynamic model identification for industrial robots. IEEE Control Syst. Mag. 2007, 27(5): 58-71. [CrossRef]

Figure 1. Theoretical and actual curve of joint torque based on identified parameters

Figure 2. Theoretical and actual curve of joint torque based on the identification algorithm in this paper

Figure 3. Trajectory of the residual vibration experiment (a) Robot experiment path (b) Inertial sensor.

Figure 4. Joint motion profiles

Figure 5. Acceleration curve in the Z direction of the robot flange in the motion process

Figure 6. Joint motion profiles after optimization

Figure 7. Residual vibration suppression effect curve in the Z direction of the flange

Table 1. Experimental platform parameters.

Equipment	Parameter items	Parameter value
Robot	Type	SIASUN T12B
	Degree of freedom	6
	Standard load	14KG
	Scope of work	1465mm
Inertial sensor	Type	XSENS MTI-100-2A8G4

Table 2. Identification results of the dynamic parameters based on physical feasibility constraints

Joint	$L_{x x}$	$L_{x y}$	$L_{x z}$	$L_{y y}$	$L_{y z}$	$L_{z z}$	$l_{x}$	$l_{y}$	$l_{z}$	$m$	$J_{m}$
1	44.876	0	0	44.876	0	1.476	0	0	0	19.965	8.8e-7
2	3.102	-0.843	-0.696	10.001	-1.549	10.089	8.828	0.517	0.371	9.261	4.245
3	4.140	1.608	0.873	3.305	0.215	4.170	3.899	6.325	0.811	16.031	0.757
4	1.724	-0.126	-0.393	1.758	-0.313	0.257	1.505	0.018	-1.768	4.489	1.505
5	0.480	0.015	-0.099	0.489	0.074	0.032	0.007	-0.005	0.035	0.002	0.156
6	0.005	-0.007	0.006	0.019	0.002	0.020	0.129	0.052	-0.049	0.965	4.422

Table 3. Identification results of the friction parameters based on physical feasibility constraints

Joint	$f_{v 1}$	$f_{c 1}$	$f_{v 2}$	$f_{c 2}$
1	123.382	26.457	51.442	70.107
2	41.718	32.308	0	0
3	35.108	32.500	0	0
4	65.267	8.969	24.356	33.791
5	15.213	3.546	2.692	10.961
6	9.032	2.277	1.713	7.442

Table 4. RMS of dynamic parameter identification results

Parameter type	Index	Joint 1	Joint 2	Joint 3	Joint 4	Joint 5
P1¹	RMS(R1)	14.650	22.683	13.826	6.547	2.680
P2²	RMS(R2)	29.388	25.806	16.875	37.783	14.737
P1 to P2	(R2-R1)/R2	50.150%	12.102%	18.068%	82.672%	81.814%

¹ Parameters with feasibility constraint; ² Parameters without constraint.

Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

© 2024 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).

Copyright: This open access article is published under a Creative Commons CC BY 4.0 license, which permit the free download, distribution, and reuse, provided that the author and preprint are cited in any reuse.

Downloads

121

Views

Comments

Subscription

Notify me about updates to this article or when a peer-reviewed version is published.

MDPI Initiatives

Important Links

Choose an area of interest and we will send you notifications of new preprints at your preferred frequency.

Disclaimer

A Terminal Residual Vibration Suppression Method of A Robot Based on Joint Trajectory Optimization

Abstract

Keywords:

Subject:

1. Introduction

2. Identification of Dynamic Parameters Based on Physical Feasibility Constraints

3. Residual Vibration Suppression Based on the Optimal Trajectory Principle

3.1. Initial Trajectory Discretization

3.2. Objective Functions and Constraints

3.3. Barycentric Interpolation

4. Experimental Verification and Analysis of Results

4.1. Identification of Dynamic Parameters

4.2. Verification of the Performance of Vibration Suppression

5. Conclusions

Author Contributions

Funding

Conflicts of Interest

References

MDPI Initiatives

Important Links

Subscribe