Hostname: page-component-74656f9884-8rzl6 Total loading time: 0 Render date: 2026-11-06T01:27:34.808Z Has data issue: false hasContentIssue false

Kinematic calibration and feedforward control of a heavy-load manipulator using parameters optimization by an ant colony algorithm

Published online by Cambridge University Press:  04 January 2024

Xinpei Wang
Affiliation:
School of Mechatronics Engineering and Automation, Foshan University, Foshan, 528225, China
Lingbo Xie
Affiliation:
School of Mechatronics Engineering and Automation, Foshan University, Foshan, 528225, China
Mian Jiang*
Affiliation:
School of Mechatronics Engineering and Automation, Foshan University, Foshan, 528225, China
Kuanfang He
Affiliation:
School of Mechatronics Engineering and Automation, Foshan University, Foshan, 528225, China
Yong Chen
Affiliation:
School of Mechatronics Engineering and Automation, Foshan University, Foshan, 528225, China
*
Corresponding author: Mian Jiang; Email: mjiang@fosu.edu.cn
Rights & Permissions [Opens in a new window]

Abstract

Most of the currently available three-degree-of-freedom manipulators are light load and cannot achieve full continuous rotation; given this, we designed a heavy-load manipulator that achieves unrestricted and continuous rotation. Due to manufacturing and assembly errors, parameter deviations between the real manipulator and its underlying theoretical model were unavoidable. Because of the lack of high-precision, high-frequency, and real-time closed-loop detection methods, we proposed a type of kinematics calibration of parameterized ant colony optimization and feedforward control methods. This was done to achieve high-precision motion control. First, an error model combining structural parameters and joint output angles was established, and the global sensitivity of each error source was analyzed to distinguish both primary and secondary sources. Based on the measured data of a laser tracker, the ant colony optimization was then used to identify six error sources. This resulted in both link length and joint driving errors of the designed manipulator. As it is a type of systematic error, the rounding error of the theoretical trajectory was carefully analyzed, and feedforward control methods with different coefficients were designed to further improve positioning accuracy based on the kinematic calibration. Experimental results showed that the proposed kinematic calibration and feedforward control methods achieved relatively precise motion control for the designed manipulator.

Information

Type
Research Article
Copyright
© The Author(s), 2024. Published by Cambridge University Press
Figure 0

Figure 1. The three-dimensional view of designed manipulator.

Figure 1

Figure 2. The error sources of designed manipulator. (a) Schematic diagram of plane projection of six error sources. (b) Three-dimensional schematic diagram of six error sources.

Figure 2

Figure 3. The generation process of joint driving errors and link length errors.

Figure 3

Figure 4. The section diagram of designed first link.

Figure 4

Figure 5. Histogram of global sensitivity coefficient. (Link length error of 0.001 m, joint driving error of 0.001 rad). (a) Sensitivity coefficient of each error source to $\delta$x. (b) Sensitivity coefficient of each error source to $\delta$y.

Figure 5

Figure 6. Histogram of global sensitivity coefficient (Link length error of 0.001 m, joint driving error of 0.01 rad). (a) Sensitivity coefficient of each error source to $\delta x$. (b) Sensitivity coefficient of each error source to $\delta y$.

Figure 6

Figure 7. Histogram of global sensitivity coefficient (Link length error of 0.0001 m, joint driving error of 0.01 rad). (a) Sensitivity coefficient of each error source to $\delta x$. (b) Sensitivity coefficient of each error source to $\delta y$.

Figure 7

Figure 8. Ratio of sensitivity coefficient of link length error to joint driving error. (a) In x-direction. (b) In y-direction.

Figure 8

Figure 9. Schematic diagram of the discrete points of global calibration.

Figure 9

Figure 10. Schematic diagram of error identification.

Figure 10

Table I. Identification results of global calibration.

Figure 11

Figure 11. Flow chart of ant colony algorithm.

Figure 12

Figure 12. The identification process of ant colony optimization. (a) fit. (b) $\delta$l1 and $\delta$l2. (c) $\delta$l3. (d) $\delta$θ1 and $\delta$θ2. (e) $\delta$θ3.

Figure 13

Figure 13. The experimental setup.

Figure 14

Table II. Average error and standard deviation of four groups of experimental trajectories.

Figure 15

Figure 14. Comparison of trajectory errors between original and global calibration. (a) Circle center of (0.3 m, 0 m), radius of 0.2 m. (b) Circle center of (0 m, 0.3 m), radius of 0.2 m. (c) Circle center of (−0.3 m, 0 m), radius of 0.2 m. (d) Circle center of (0 m, −0.3 m), radius of 0.2 m.

Figure 16

Table III. Identification results of local calibration.

Figure 17

Figure 15. Schematic diagram of the discrete points of local calibration.

Figure 18

Figure 16. The identification process of ant colony optimization. (a) fit. (b) $\delta$l1 and $\delta$l2. (c) $\delta$l3. (d) $\delta$θ1 and $\delta$θ2. (e) $\delta$θ3.

Figure 19

Table IV. Average error and standard deviation of different calibration methods.

Figure 20

Figure 17. Comparison of trajectory errors of different calibration methods.

Figure 21

Figure 18. The theoretical and actual output angles.

Figure 22

Table V. Data statistics of trajectory error.

Figure 23

Figure 19. Trajectory errors with and without rounding operation. (a) Complete figure. (b) Zoom in on the red box of (a).

Figure 24

Figure 20. Effect of $\Delta$T on theoretical trajectory error. (a) Complete figure. (b) Zoom in on the 1/$\Delta$T axis from 0 to 100. (c) Zoom in on the 1/$\Delta$T axis from 100 to 1000.

Figure 25

Figure 21. Trajectory errors of repeated experiments.

Figure 26

Figure 22. Flowchart of feedforward control based on kinematic calibration.

Figure 27

Figure 23. Feedforward control effect with and without calibration.

Figure 28

Figure 24. Trajectory errors with different feedforward coefficients. (a) Without calibration. (b) With local calibration.

Figure 29

Table VI. Average error and standard deviation.

Figure 30

Figure 25. Trajectory errors of different feedforward control and calibration methods. (a) Without feedforward control (same as Fig. 17). (b) Global calibration with feedforward control. (c) Local calibration with feedforward control. (d) Feedforward control with different calibrations.

Figure 31

Table A1. The meaning of the given symbols.