Journal of Textile Research ›› 2023, Vol. 44 ›› Issue (06): 207-214.doi: 10.13475/j.fzxb.20211107501

• Machinery & Accessories • Previous Articles     Next Articles

Trajectory tracking control method of cloth grabbing manipulator based on dynamic modeling

HUANG Chenjing, ZHANG Lei(), SUN Xun, WANG Xiaohua   

  1. College of Electronics and Information, Xi'an Polytechnic University, Xi'an, Shaanxi 710048, China
  • Received:2021-11-16 Revised:2023-01-07 Online:2023-06-15 Published:2023-07-20
  • Contact: ZHANG Lei E-mail:carol1208@163.com

Abstract:

Objective With the development and popularization of advanced manufacturing technology, the fabric grabbing and transferring work in the textile and garment industry has been preliminarily realized by the use of manipulator. However, in practical applications, the parameters of the manipulator model cannot be accurately measured, and the tracking accuracy would decrease when using the traditional control method. Therefore, it is of great significance to study the trajectory tracking control problem of manipulator with consideration of the uncertain model parameter.
Method Aiming at the dynamic model of the manipulator with parameter uncertainty, a trajectory tracking control method was designed by using backstepping method under the framework of I&I adaptive theory. The dynamic model of flexible joint manipulator with unknown parameters was established before, the adaptive joint moment of inertia was designed using Immersion and Invariance(I&I) adaptive control method, and the invariance and attraction characteristics of error manifold were facilitated through designing a smooth function to ensure that the parameter estimation error converge to zero. Finally, the designed adaptive law is introduced into the recursive process of control law designing to make it adaptive to the uncertain parameter.
Results The adaptive law designed by the I&I adaptive control method has adaptiveness for the uncertain parameter, and the parameter estimation error response curve quickly converges to 0 after a short running time(Fig. 9). Compared with the FPBC(fixed parameter model based backstepping control method), the proposed IABC(I&I adaptive based backstepping control method)was found not only to achieve the desired trajectory tracking effect faster and more stably, but also to stabilize the input torque of the motor faster. The manipulator using FPBC did not track the expected trajectory and has periodic tracking errors(Fig. 5), and the manipulator using proposed IABC tracked the desired trajectory for the first time after about 0.12 s of joint position, and demonstrated good tracking performance, with the tracking error of desired trajectory within ± 0.002 rad. The motor input torque under FPBC entered a stable state around 0.14 s, while under the IABC proposed in this paper, the motor input torque tended to stabilize around 0.07 s(Fig. 6 and Fig. 7). It is obvious that the FPBC made the motor input torque enter a stable state at about 0.14 s, while the IABC proposed in this research made the motor input torque enter a stable state at about 0.07 seconds(Fig. 6 and Fig. 7). In order to verify the trajectory tracking of manipulator end in cloth grabbing and placing, the desired trajectory tracking experiment of manipulator end was simulated using MatLab. The proposed IABC was shown to be effective in achieving accurate trajectory tracking control of the cloth grabbing manipulator(Fig. 10).
Conclusion The proposed IABC can effectively improve the tracking performance of the manipulator joint position and improve the tracking accuracy of the cloth grabbing manipulator. This method takes into account the uncertainty of the moment of inertia of the manipulator dynamic model. I&I adaptive control method is used to design the parameter adaptive law to avoid the over-parameterization problem of the adaptive method based on the Certainty Equivalence principle, while retaining the nonlinear characteristics of the system.

Key words: cloth grabbing manipulator, dynamic model, position tracking, immersion and invariance adaptive, backstepping method

CLC Number: 

  • TP242.2

Fig. 1

Flexible joint manipulator equivalent model"

Fig. 2

Structure diagram of trajectory tracking control system of grasping manipulator"

Fig. 3

FPBC tracking performance"

Fig. 4

Tracking performance of IABC"

Fig. 5

Joint position tracking error under different control methods"

Fig. 6

Motor torque under FPBC"

Fig. 7

Motor torque under IABC"

Fig. 8

Response curve of θ ^ and β(x1,x2)"

Fig. 9

Response curve of parameter estimated error z"

Fig. 10

Tracking of cloth grabbing manipulator under IABC"

[1] 中国纺织工业联合会. 纺织行业“十四五”发展纲要[J]. 纺织科学研究, 2021(7): 40-49.
China National Textile and Apparel Council. Development outline of the 14th five year plan of textile industry[J]. Textile Science Research, 2021(7): 40-49.
[2] 梅顺齐, 胡贵攀, 王建伟, 等. 纺织智能制造及其装备若干关键技术的探讨[J]. 纺织学报, 2017, 38(10): 166-171.
MEI Shunqi, HU Guipan, WANG Jianwei, et al. Analysis of some key technology basis for intelligent textile manufacturing and its equipment[J]. Journal of Textile Research, 2017, 38(10): 166-171.
[3] 刘汉邦, 李新荣, 刘立东. 服装面料自动抓取转移方法的研究进展[J]. 纺织学报, 2021, 42(1): 190-196.
LIU Hanbang, LI Xinrong, LIU Lidong, et al. Research progress of automatic grabbing and transfer methods for garment fabrics[J]. Journal of Textile Research, 2021, 42(1): 190-196.
[4] 张蕾, 韦攀东, 李鹏飞, 等. 采用神经网络算法的多指机械手织物抓取规划[J]. 纺织学报, 2017, 38(1): 132-139.
ZHANG Lei, WEI Pandong, LI Pengfei, et al. Fabric grasp planning for multi-fingered dexterous hand based on neural network algorithm[J]. Journal of Textile Research, 2017, 38(1): 132-139.
[5] 严俨. 基于机器视觉的机器人拾放料系统研究[D]. 杭州: 浙江大学, 2015 :12-14.
YAN Yan. Research on pick-and place robotics system based on machine vision[D]. Hangzhou: Zhejiang University, 2015 :12-14.
[6] LIANG X, CHEONG H, SUN Y, et al. Design, characterization, and implementation of a two-dof fabric-based soft robotic arm[J]. IEEE Robotics & Automation Letters, 2018, 3(3): 2702-2709.
[7] 张胜, 方向, 赵志成, 等. 基于反馈线性化的软壳体球形机器人纵向运动控制[J]. 机械工程学报, 2017, 53(3): 43-50.
doi: 10.3901/JME.2017.03.043
ZHANG Sheng, FANG Xiang, ZHAO Zhicheng, et al. Longitudinal montion controlling for a spherical rolling robot with soft shell based on feedback linearization[J]. Journal of Mechanical Engineering, 2017, 53(3): 43-50.
doi: 10.3901/JME.2017.03.043
[8] TAHERI B, CASE D, RICHER E. Force and stiffness backstepping-sliding mode controller for pneumatic cylinders[J]. IEEE/ASME Transactions on Mechatronics, 2014, 19(6): 1799-1809.
doi: 10.1109/TMECH.2013.2294970
[9] 安凯, 王飞飞. 一种单连杆机械臂柔性关节的滑模变结构控制[J]. 现代电子技术, 2016, 39(2): 4-8.
AN Kai, WANG Feifei. Sliding mode variable structure control for flexible joint of single connecting-rod mechanical arm[J]. Modern Electronics Technique, 2016, 39(2): 4-8.
[10] LIU Y J, GAO Y, TONG S, et al. Fuzzy approximation-based adaptive backstepping optimal control for a class of nonlinear discrete-time systems with dead-zone[J]. IEEE Transactions on Fuzzy Systems, 2016, 24(1): 16-28.
doi: 10.1109/TFUZZ.2015.2418000
[11] NIKDEL N, BADAMCHIZADEH M, AZIMIRAD V, et al. Fractional-order adaptive backstepping control of robotic manipulators in the presence of model uncertainties and external disturbances[J]. IEEE Transactions on Industrial Electronics, 2016, 63(10): 6249-6256.
doi: 10.1109/TIE.2016.2577624
[12] 杜学丹, 蔡莹皓, 鲁涛, 等. 一种基于深度学习的机械臂抓取方法[J]. 机器人, 2017, 39(6): 820-828.
doi: 10.13973/j.cnki.robot.2017.0820
DU Xuedan, CAI Yinghao, LU Tao, et al. A robotic grasping method based on deep learning[J]. Robot, 2017, 39(6): 820-828.
doi: 10.13973/j.cnki.robot.2017.0820
[13] 李树荣, 尹怀强. 具有时滞的柔性关节多机械臂协同自适应位置/力控制[J]. 控制理论与应用, 2017, 34(9): 1208-1214.
LI Shurong, YIN Huaiqiang. Adaptive position/force control for coordinated multiple flexible-joint manipulators with time delay[J]. Control Theory & Applications, 2017, 34(9): 1208-1214.
[14] BRAHMI A, SAAD M, GAUTHIER G, et al. Tracking control of mobile manipulator robot based on adaptive backstepping approach[J]. International Journal of Digital Signals & Smart Systems, 2017, 1(3): 224-238.
[15] KRSTIĆ M, KANELLAKOPOULOS I, KOKOTOVIĆ P. Adaptive nonlinear control without overparametriza-tion[J]. Systems & Control Letters, 1992, 19(3): 177-185.
doi: 10.1016/0167-6911(92)90111-5
[16] ASTOLFI A, KARAGIANNIS D. Nonlinear and adaptive control with applications[M]. London: Springer-Verlag, 2008: 55-72.
[17] KARAGIANNIS D, ASTOLFI A. Nonlinear adaptive control of systems in feedback form: an alternative to adaptive backstepping[J]. Systems & Control Letters, 2008, 57(9): 733-739.
doi: 10.1016/j.sysconle.2008.02.006
[18] ASTOLFI A, ORTEGA R. Immersion and invariance: a new tool for stabilization and adaptive control of nonlinear systems[J]. IEEE Transactions on Automatic Control, 2003, 48(4): 590-606.
doi: 10.1109/TAC.2003.809820
[19] 夏冬冬, 岳晓奎. 基于浸入与不变理论的航天器姿态跟踪自适应控制[J]. 航空学报, 2020, 41(2): 307-318.
XIA Dongdong, YUE Xiaokui. Immersion and invariance based attitude adaptive tracking control for space-craft[J]. Acta Aeronautica et Astronautica Sinica, 2020, 41(2): 307-318.
[20] 李晓静, 吴爱国, 张兆龙. 基于浸入和不变技术的非线性跟踪控制[J]. 控制理论与应用, 2019, 36(1): 75-80.
LI Xiaojing, WU Aiguo, ZHANG Zhaolong. Immersion and invariance modular nonlinear tracking contrlol for an underactuated quadrotor[J]. Control Theory & Applications, 2019, 36(1): 75-80.
[21] SPONG M W. Modeling and control of elastic joint robots[J]. Journal of Dynamic Systems Measurement and Control, 1987, 109(4): 310-319.
doi: 10.1115/1.3143860
[22] TALOLE S E, KOLHE J P, PHADKE S B. Extended-state-observer-based control of flexible-joint system with experimental validation[J]. IEEE Transactions on Industrial Electronics, 2010, 57(4): 1411-1419.
doi: 10.1109/TIE.2009.2029528
[23] OLFATI-SABER R. Flocking for multi-agent dynamic systems: algorithms and theory[J]. IEEE Transactions on Automatic Control, 2006, 51(3): 401-420.
doi: 10.1109/TAC.2005.864190
[24] SLOTINE J, LI W P. Applied nonlinear control[M]. London: Prentice-Hall International (UK), 1991: 64-65.
[1] QIAN Cheng, LIU Yanqing, LIU Xinjin, XIE Chunping, SU Xuzhong. Simulation and analysis of trajectory of fibers in a four-roller compact spinning system [J]. Journal of Textile Research, 2020, 41(03): 39-44.
[2] . Modeling and simulation of transverse motion error of guide bar shogging system of warp knitting machine [J]. JOURNAL OF TEXTILE RESEARCH, 2018, 39(08): 130-137.
[3] . Dynamic analysis od shogging motion mechanism of guide bar on warp knitting machine [J]. JOURNAL OF TEXTILE RESEARCH, 2012, 33(11): 121-126.
[4] SONG Xiao-xia;FENG Xun-wei. Relationship between garment pressure and human body comfortableness [J]. JOURNAL OF TEXTILE RESEARCH, 2006, 27(3): 103-105.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!