Trajectory Planning of a Three-arm Space Robot Based on Pose Feedback

Abstract

Abstract: A trajectory planning algorithm was proposed based on pose error feedback for a three-arm space robot.The pose error problems might be solved when the robot went through a singular region.The kinematics model of the three-arm space robot was established by general kinematics equation and law of momentum conservation.The pose error kinematics equations were established by position and attitude expectations.Taking joint angular velocity as the control variable, a controller was designed based on error feedback of end-effectors and bases.The tracking errors of closed-loop system possessed specified exponential convergence rates.The method may reduce pose errors in the neighborhood of singularity points and eliminate the errors completely after leaving singular regions.Simulation results demonstrate the effectiveness of the proposed trajectory planning method.

Key words: space robot, singular value, pose, feedback control

摘要： 以三臂空间机器人为研究对象，针对经历奇异位形时出现的位姿误差问题，提出一种基于位姿误差反馈的轨迹规划算法。根据系统一般运动学方程并结合动量守恒方程建立系统运动学模型，利用位姿期望指令得到误差运动方程。以关节角速度为控制量，设计了基于位姿误差反馈的控制率，使闭环系统的跟踪误差按指数速度收敛。该方法能够减小机器人奇异点邻域内的位姿跟踪误差，且在离开奇异区域后能完全消除误差。仿真结果证明了该方法的有效性。

关键词: 航天机器人, 奇异值, 位姿, 反馈控制

CLC Number:

TP242.3

LAN Qijie1，3;LIU Yicheng1;ZHANG Tao2. Trajectory Planning of a Three-arm Space Robot Based on Pose Feedback[J]. China Mechanical Engineering.

蓝启杰1，3;刘宜成1;张涛2. 基于位姿反馈的三臂空间机器人抓捕轨迹规划[J]. 中国机械工程.

References

[1]KUMAR A，PATHAK P M.Trajectory Control of a Two DOF Rigid-flexible Space Robot by a Virtual Space Vehicle[J].Robotics and Autonomous Systems，2013，61：473-482.
[2]LIU Xiaofeng，LI Haiquan，CHEN Yijun，et al.Dynamics and Control of Space Robot Considering Joint Friction[J].Acta Astronautica，2015，111：1-18.
[3]KHALOOZADEH H，HOMAEINEJAD M R.Real-time Regulated Sliding Mode Controller Design of Multiple Manipulator Space Free-flying Robot[J].Journal of Mechanical Science and Technology，2010，24（6）：1337-1351.
[4]KING D.Space Servicing：Past，Present and Future[C]//Proceeding of the 6th International Symposium on Artificial Intelligence，Robot and Automation in Space.Montreal，2001：346-351.
[5]黄晋英，杜为民，李辉.三臂机器人在轨动力学仿真[J].中国机械工程，2016，27（3）：328-333.
HUANG Jinying，DU Weimin，LI Hui.Dynamic Simulation for a Three-arm Robot on Orbit[J].China Mechanical Engineering，2016，27（3）：328-333.
[6]徐文福，刘厚德，李成，等.双臂空间机器人捕获运动目标的自主路径规划[J].机器人，2012，34（6）：704-713.
XU Wenfu，LIU Houde，LI Cheng，et al．Autonomous Path Planning of Dual-arm Space Robot for Capturing Moving Target[J].Robot，2012，34（6）：704-713.
[7]徐文福，刘宇，强文义，等.自由漂浮空间机器人的笛卡尔连续路径规划[J].控制与决策，2008，23（3）：278-282.
XU Wenfu，LIU Yu，QIANG Wenyi，et al.Cartesian Continuous-path Planning for Free-floating Space Robot[J].Control & Decision，2008，23（3）：278-282.
[8]BUSS S R，KIM J S.Selectively Damped Least Squares for Inverse Kinematics[J].Journal of Graphics，GPU，and Game Tools，2005，10（3）：37-49.
[9]徐文福，梁斌，刘宇，等.一种新的PUMA类型机器人奇异回避算法[J].自动化学报，2008，34（6）：670-675.
XU Wenfu，LIANG Bin，LIU Yu，et al．A Novel Approach to Avoid Singularities of PUMA-type Manipulators [J].Acta Automatica.2008，34（6）：670-675.
[10]吴戈，张国良，羊帆，等.一种改进阻尼倒数的空间机器人避奇异算法[J].宇航学报，2016，37（3）：325-333.
WU Ge，ZHANG Guoliang，YANG Fan，et al．A Singularity Avoidance Algorithm Based on Improved Damped Reciprocal for Space Robot[J].Journal of Astronautics，2016，37（3）：325-333.
[11]张福海，付宜利，王树国.自由漂浮空间机器人回避动力学奇异的轨迹规划[J].机器人，2012，34（1）：38-43.
ZHANG Fuhai，FU Yili，WANG Shuguo.Tajectory Planning of Free-floating Space Robot with Avoidance of Dynamic Singularity[J].Robot，2012，34（1）：38-43.
[12]吴剑威，史士财，刘宏.自由飘浮空间机器人笛卡尔避奇异运动规划[J].华中科技大学学报（自然科学版），2009，37（11）：5-8.
WU Jianwei，SHI Shicai，LIU Hong.Cartesian Singularity-avoiding Path Planning for Free-floating Space Robot[J].Journal of Huazhong University of Science & Technology（Natural Science），2009，37（11）：5-8.
[13]刘松国，朱世强，程永伦.一般6R 机器人的高精度逆运动学算法研究[J].中国机械工程，2007，28（18）：2413-2418.
LIU Songguo，ZHU Shiqiang，CHENG Yonglun.Research on Inverse Kinematics Algorithm with High Accuracy for a General 6R Robot [J].China Mechanical Engineering，2007，28（18）：2413-2418.

[1]	HU Xinyu, ZHANG Junwei, AI Jia, LI Yunling, YAN Shuang. A Small-sample Defect Detection Method for Screen-printed Characters with Adaptive Target Region Extraction [J]. China Mechanical Engineering, 2025, 36(12): 2968-2977.
[2]	Wei YANG, Chen JIA, Chao HE, Wenxin FAN, Zhiqiang FAN, Zhenglu LI. Study on Flow Characteristics of Variable Displacement Opposed Piston Pumps [J]. China Mechanical Engineering, 2025, 36(11): 2633-2640.
[3]	WANG Lei1, 2, FANG Zichen1, WANG Zhentao1, SUN Liang1, 2, YU Gaohong1, 2, CUI Rongjiang3. Mixed Multi Pose Synthesis Method and Applications of Unequal Velocity Planetary Gear Trains [J]. China Mechanical Engineering, 2024, 35(12): 2211-2220.
[4]	LIU Songyong1, WU Hongzhuang2, CHENG Cheng2, SONG Mingjiang1, 3, CUI Yuming4. Self-positioning Cutting Control Methods and Experimental Research for Coal Mine Roadheaders [J]. China Mechanical Engineering, 2024, 35(07): 1318-1329.
[5]	ZHONG Xungao1, 4, LUO Jiaguo1, TIAN Jun2, ZHONG Xunyu2, PENG Xiafu2, LIU Qiang3. Robot Vision Closed-loop Pose Autonomous Coordination Method with Second-order Cone Constrained Programming [J]. China Mechanical Engineering, 2024, 35(06): 1064-1073.
[6]	JIANG Jiguang, HOU Jue, SU Chengzhi, BA Qijiao, TIAN Aixin, XU Mingyu. Research on Optimal Pose Set Planning Method under Physical Constraint Robot Kinematics Calibration [J]. China Mechanical Engineering, 2024, 35(03): 472-480.
[7]	ZHONG Yongbin, GAO Jian, FENG Fuyuan, ZHANG Lanyu, . Fractional-order Feedback Control Method for PMLSMs Based on Closed-loop Identification Model [J]. China Mechanical Engineering, 2023, 34(23): 2773-2780，2793.
[8]	SUN Luping, ZHANG Wenchang, WANG Zhihua, WANG Zhenwen, REN Zhimo, ZHANG Qian, . Measurement Method of Cabin Automatic Docking Based on 2D Laser Displacement Sensor [J]. China Mechanical Engineering, 2023, 34(09): 1120-1125,1133.
[9]	ZHU An, AI Haiping, CHEN Li. Compliance Control of Dual-arm Space Robot Capture Satellite Based on Barrier Lyapunov Functions [J]. China Mechanical Engineering, 2022, 33(24): 2997-3006.
[10]	MA Yuhao, LI Yong, JIANG Lei, DING Guofu. Wheel-grinding Position and Pose Algorithm of Flank Faces of Cutting-breaking Drill Tips [J]. China Mechanical Engineering, 2021, 32(19): 2321-2325,2330.
[11]	YI Huaian, ZHAO Xinjia, TANG Le, CHEN Yonglun. Vision Measurement Method for Ground Surface Roughness Based on Color Image Singular Value Entropy Index#br# [J]. China Mechanical Engineering, 2021, 32(13): 1577-1583.
[12]	TANG Guiji;LI Nannan;WANG Xiaolong. Fault Feature Extraction Method for Gears Based on ISSD and SVD [J]. China Mechanical Engineering, 2020, 31(24): 2988-2996.
[13]	MENG Zong;LIU Zihan;LYU Meng. Fault Diagnosis for Rolling Bearings Based on Improved Singular Value Decomposition and Spectral Kurtosis [J]. China Mechanical Engineering, 2020, 31(20): 2420-2428.
[14]	WANG Xinyu；QIN Wei；SUN Xiaojun；HU Xiaoliang. Nonlinear Synchronous Robust Control for 3-PPR Parallel Servo Platforms [J]. China Mechanical Engineering, 2020, 31(19): 2269-2275.
[15]	LIU Jian;WANG Yuanyuan. A Method of Image Perspective Distortion Correction in Ball Pose Detections [J]. China Mechanical Engineering, 2019, 30(18): 2242-2249,2256.