基于位姿反馈的三臂空间机器人抓捕轨迹规划

摘要/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

中图分类号:

TP242.3

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

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

参考文献

[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]	唐贵基;李楠楠;王晓龙. 综合改进奇异谱分解和奇异值分解的齿轮故障特征提取方法[J]. 中国机械工程, 2020, 31(24): 2988-2996.
[2]	孟宗;刘子涵;吕蒙. 基于改进奇异值分解滤波和谱峭度的滚动轴承故障诊断[J]. 中国机械工程, 2020, 31(20): 2420-2428.
[3]	王薪宇；秦伟；孙晓军；胡小亮. 3-PPR并联伺服平台非线性同步鲁棒控制[J]. 中国机械工程, 2020, 31(19): 2269-2275.
[4]	陈栋;李世其;王峻峰;丰意;何旺. 一种以测量关键特征拟合舱段位姿的方法[J]. 中国机械工程, 2019, 30(18): 2250-2256.
[5]	张文颢1;李永健2,3;张卫华1. 基于K-奇异值分解和层次化分块正交匹配算法的滚动轴承故障诊断[J]. 中国机械工程, 2019, 30(04): 406-412.
[6]	金贺荣1，2;刘;达1，2. 面向筒类舱段自动装配的两点定位调姿方法[J]. 中国机械工程, 2018, 29(12): 1467-1474.
[7]	邓傲然;孙启鹏;张炎;李刚炎. 平面低速重载机构位姿误差分析中的转动副间隙等效计算方法[J]. 中国机械工程, 2018, 29(01): 69-74.
[8]	洪波1,2;尹力1,2;李毅1,2;李湘文1,2. 基于激光位移传感器的角焊缝位姿检测[J]. 中国机械工程, 2017, 28(24): 3013-3016,3023.
[9]	苏春;黄漪. 装配误差传递建模及其精度可靠性评估[J]. 中国机械工程, 2017, 28(19): 2359-2364.
[10]	韩振华;刘书桂;高礼圳;余飞. 智能三坐标测量机的零件位姿识别[J]. 中国机械工程, 2017, 28(14): 1730-1734,1741.
[11]	张建宇, 孟浩, 胥永刚. 基于信源估计和频域反卷积的滚动轴承故障特征分离与辨识[J]. 中国机械工程, 2017, 28(01): 45-51.
[12]	金贺荣, 刘达, 于斌, 范秀斌. 舱段自动装配位姿求解方法研究[J]. 中国机械工程, 2017, 28(01): 88-92.
[13]	刘彬, 李鹏, 刘飞, 刘浩然, 姜甲浩. 液压缸非线性刚度作用下的轧机辊系振动行为及控制[J]. 中国机械工程, 2016, 27(23): 3190-3196.
[14]	张旭, 郑泽龙. 主动光立体标靶检测及其在工业机器人位姿测量中的应用[J]. 中国机械工程, 2016, 27(19): 2594-2601.
[15]	吴芬, 黄美发, 陈磊磊, 吴常林. 基于多分辨率奇异值分解的表面滤波方法[J]. 中国机械工程, 2016, 27(13): 1766-1772.