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

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

导出引用管理器 EndNote|Ris|BibTeX

链接本文: https://www.cmemo.org.cn/CN/

https://www.cmemo.org.cn/CN/Y2018/V29/I20/2495

参考文献

[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]. 中国机械工程, 2025, 36(12): 2968-2977.
[2]	王磊1, 2, 方子辰1, 王振涛1, 孙良1, 2, 俞高红1, 2, 崔荣江3. 不等速行星轮系机构混合多位姿综合方法及应用[J]. 中国机械工程, 2024, 35(12): 2211-2220.
[3]	郭丰泽, 杨博, 戎志祥, 杨俊曼, 冯熠硕. 基于位敏传感器的对中监测系统[J]. 中国机械工程, 2024, 35(08): 1509-1519.
[4]	刘送永1, 吴洪状2, 程诚2, 宋明江1, 3, 崔玉明4. 煤矿掘进机自定位截割控制方法及试验研究[J]. 中国机械工程, 2024, 35(07): 1318-1329.
[5]	仲训杲1, 4, 罗家国1, 田军2, 仲训昱2, 彭侠夫2, 刘强3. 二阶锥约束规划的机器人视觉闭环位姿自协调方法[J]. 中国机械工程, 2024, 35(06): 1064-1073.
[6]	姜吉光, 侯爵, 苏成志, 巴麒蛟, 田爱鑫, 徐明宇. 面向物理约束的机器人运动学标定最优位姿集规划方法研究[J]. 中国机械工程, 2024, 35(03): 472-480.
[7]	钟永彬, 高健, 冯富原, 张揽宇, . 基于闭环辨识模型的永磁同步直线电机分数阶反馈控制方法[J]. 中国机械工程, 2023, 34(23): 2773-2780，2793.
[8]	孙露萍, 张文昌, 王志华, 王振文, 任志墨, 张倩, . 基于2D激光位移传感器的舱段自动对接测量方法[J]. 中国机械工程, 2023, 34(09): 1120-1125,1133.
[9]	李猛, 王时龙, 马驰, 夏长久. 基于齿面位姿几何误差模型的大规格滚齿机关键误差识别[J]. 中国机械工程, 2023, 34(05): 533-542.
[10]	舒林森, 巩江涛, 董月, 苏成明, 王昕. 阀芯零件激光再制造工艺方法及试验研究[J]. 中国机械工程, 2023, 34(04): 446-453.
[11]	倪华康, 杨泽源, 杨一帆, 陈新渡, 严思杰, 丁汉. 考虑基坐标系误差的机器人运动学标定方法[J]. 中国机械工程, 2022, 33(06): 647-655.
[12]	马玉豪, 李勇, 江磊, 丁国富. 断屑钻尖后刀面的砂轮磨削位姿算法[J]. 中国机械工程, 2021, 32(19): 2321-2325,2330.
[13]	孟宗, 郜文清, 潘作舟, 张光雅, 樊凤杰. G-KSVD字典及其在滚动轴承故障信号稀疏表示中的应用[J]. 中国机械工程, 2021, 32(15): 1776-1785.
[14]	易怀安, 赵欣佳, 唐乐, 陈永伦. 基于彩色图像奇异值熵指标的磨削表面粗糙度视觉测量方法[J]. 中国机械工程, 2021, 32(13): 1577-1583.
[15]	唐贵基;李楠楠;王晓龙. 综合改进奇异谱分解和奇异值分解的齿轮故障特征提取方法[J]. 中国机械工程, 2020, 31(24): 2988-2996.