CN117245653B - 一种空间机械臂抓捕非合作喷管的运动规划方法 - Google Patents
一种空间机械臂抓捕非合作喷管的运动规划方法 Download PDFInfo
- Publication number
- CN117245653B CN117245653B CN202311189954.7A CN202311189954A CN117245653B CN 117245653 B CN117245653 B CN 117245653B CN 202311189954 A CN202311189954 A CN 202311189954A CN 117245653 B CN117245653 B CN 117245653B
- Authority
- CN
- China
- Prior art keywords
- planning
- mechanical arm
- cooperative
- stage
- capturing
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 239000007921 spray Substances 0.000 title claims abstract description 22
- 238000003032 molecular docking Methods 0.000 claims abstract description 22
- 230000000007 visual effect Effects 0.000 claims abstract description 19
- 239000012636 effector Substances 0.000 claims abstract description 10
- 230000008859 change Effects 0.000 claims abstract description 9
- 238000005096 rolling process Methods 0.000 claims abstract description 5
- 230000001133 acceleration Effects 0.000 claims description 19
- 239000011159 matrix material Substances 0.000 claims description 15
- 230000009466 transformation Effects 0.000 claims description 9
- 230000011218 segmentation Effects 0.000 claims description 3
- 230000007547 defect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 7
- 210000001503 joint Anatomy 0.000 description 3
- 230000036461 convulsion Effects 0.000 description 2
- 230000000875 corresponding effect Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 101000606504 Drosophila melanogaster Tyrosine-protein kinase-like otk Proteins 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000002079 cooperative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
一种空间机械臂抓捕非合作喷管的运动规划方法，它涉及一种运动规划方法。本发明为了解决现有轨迹规划算法存在较多缺陷，难以满足实际抓捕需求的问题。本发明由视觉跟踪阶段和直接对接阶段两部分组成，视觉跟踪阶段是根据目标位姿反馈，动态规划机械臂接近至翻滚卫星喷管端面的轨迹，直接对接阶段是规划机械臂沿对接方向的运动速度，在笛卡尔空间下期望轨迹仅有位置变化，无姿态调整，依赖末端执行器头部主动变形适应喷管的姿态变化。本发明属于航空航天领域。
Description
技术领域
本发明涉及一种运动规划方法，属于航空航天领域。
背景技术
空间轨道上的失效非合作目标日益增多，严重威胁了在轨航天器的安全运行，研究非合作目标捕获技术具有重要意义。基于现有文献，非合作目标捕获方法可分为基于抓持结构的捕获方式和不基于抓持结构的捕获方式。不基于抓持结构的捕获方式多种多样，适用于捕获不同形状的目标，有非接触式捕获和柔性捕获，捕获方法有整体包络的，也有局部作用的，由于该方式不基于抓持机构，被捕获目标容易受到扰动而改变位姿，仅适用于离轨清除任务。基于抓持结构的捕获方式一般指机械臂采用特定的末端执行器抓捕目标，与目标形成稳定的复合体，相比于不基于抓持结构的捕获方式，可开展失效目标接管和高价值目标复用。该捕获方式的抓持结构一般选取目标的固有结构，如：轨控发动机喷管、星箭对接环和帆板支架等。FREND项目配备了3个机械臂，由机器视觉进行服务星与目标的相对位姿测量，多机械臂协同动作可对目标的星箭对接环、分离螺栓进行捕获，是一种三指夹持对接方式；DEOS计划配备了1个轻型机械臂，通过手爪闭合对目标手柄进行捕获；轨控发动机喷管安装在卫星质心的轴线上，采用锥-杆式对接捕获不会产生卫星倾覆力矩，捕获时受力情况更优：SMART-OLEV服务星、MEV服务星采用锥形杆末端执行器对喷管进行捕获，是一种类锥-杆式对接方式：SMART-OLEV服务星根据激光传感器等反馈数据不断调整末端执行器位姿，避免其与喷管内壁碰撞，算法复杂；MEV服务星利用末端执行器与喷管内壁贴合导引至喷管喉部位置，对接算法简单，但伸缩臂只有一个自由度，工作空间不灵活。
基于抓持结构的捕获方式灵活度较高，但如何基于视觉反馈自主规划机械臂运动仍是关键难点。
常用的轨迹规划算法有多项式规划算法、直线加减速规划算法、S型加减速规划算法。多项式规划算法计算简单，阶次越高(一般不超过7次)，曲线越平滑，可保证速度和加加速度曲线的连续性；直线加减速规划算法下，加速度曲线不连续，速度曲线不平滑，机械臂震颤，轨迹精度低；S型加减速规划算法，加速度曲线连续，运动平稳性好，冲击性小。上述规划方式适用于已知轨迹点的离线规划，无法直接应用于基于视觉反馈的动态规划。
发明内容
本发明为解决现有轨迹规划算法存在较多缺陷，难以满足实际抓捕需求的问题，进而提出一种空间机械臂抓捕非合作喷管的运动规划方法。
本发明为解决上述问题采取的技术方案是：本发明所述运动规划方法由视觉跟踪阶段和直接对接阶段两部分组成，视觉跟踪阶段是根据目标位姿反馈，动态规划机械臂接近至翻滚卫星喷管端面的轨迹，直接对接阶段是规划机械臂沿对接方向的运动速度，在笛卡尔空间下期望轨迹仅有位置变化，无姿态调整，依赖末端执行器头部主动变形适应喷管的姿态变化。
进一步的，视觉跟踪阶段采用多项式插值法规划五次多项式插值算法能保障位置、速度和加速度曲线连续，其插值通式及边界约束条件如下：
s(t)＝a0+a1t+a2t2+a3t3+a4t4+a5t5
s(0)＝0,s(tf)＝sf
整理得一维的五次多项式插值式：
公式(1)和(2)中，Init(sf)表示初始时刻末端期望轨迹点相对于初始轨迹点的初始偏差值，tf表示规划时长，s(t)-Init(sf)的差值表示为反向规划值，即规划点相对于期望末端轨迹点的偏差；
将此算法拓展到六维，即通过对位置量(Dx,Dy,Dz)和姿态量ZYX欧拉角(Ex,Ey,Ez)进行五次多项式插值，完成视觉跟踪阶段的反向规划。
进一步的，引入机械臂从ti时刻规划点向ti+1时刻规划点动作，获取两个规划点间的位姿变换矩阵矩阵/>通过矩阵/>运算得到；其中，通过相机数据获得目标相对于机械臂末端的坐标变换矩阵/>通过反向规划算法获得规划点相对于目标的坐标变换矩阵最终，由机械臂的正运动学、关节位置反馈qc和逆运动学，得到机械臂末端期望轨迹对应的期望关节角qd。
进一步的，直接对接阶段只需对位置量(Dx)规划，其他位姿量(Dy,Dz,Ex,Ey,Ez)规划值为0，为使加速度曲线是平滑连续的，基于正弦函数分段规划了直线轨迹，算法具体形式为：
公式(4)、(5)、(6)中Amax＝(25πxf)/(8T2)为最大加速度值；xf为总的规划值，即机械臂末端坐标系X轴向的预期进给总长，T为总的规划时长。
进一步的，关节空间轨迹规划的关节参考加速度为：
公式(7)中，e＝qd-qc。
本发明的有益效果是：本发明针对喷管抓捕末端执行器可自主偏摆，对接容差大的特点，建立了机械臂视觉导引与直接对接混合的运动规划方案。提出的基于五次多项式的逆向规划方法，实现了机械臂对动态目标的实时伺服跟踪；基于正弦函数的直线规划方法，实现了末端执行器与翻滚卫星的可靠对接；三阶的关节伺服控制模型生成加加速度级的参考轨迹，消除了轨迹的不连续性对伺服精度的影响。
附图说明
图1是捕获***组成示意图；
图2是视觉跟踪阶段示意图；
图3是直接对接阶段示意图；
图4是动目标反向规划示意图；
图5是视觉跟踪阶段的规划示意图；
图6是视觉跟踪阶段的笛卡尔规划整体框图；
图7是基于正弦函数的加减速直线规划算法示意图；
图8是关节的规划算法控制框图。
具体实施方式
具体实施方式一：结合图1至图8说明本实施方式，本实施方式所述一种空间机械臂抓捕非合作喷管的运动规划方法由视觉跟踪阶段和直接对接阶段两部分组成，视觉跟踪阶段是根据目标位姿反馈，动态规划机械臂接近至翻滚卫星喷管端面的轨迹，直接对接阶段是规划机械臂沿对接方向的运动速度，在笛卡尔空间下期望轨迹仅有位置变化，无姿态调整，依赖末端执行器头部主动变形适应喷管的姿态变化；
具体实施方式二：结合图1至图8说明本实施方式，本实施方式所述一种空间机械臂抓捕非合作喷管的运动规划方法的视觉跟踪阶段采用多项式插值法规划五次多项式插值算法能保障位置、速度和加速度曲线连续，其插值通式及边界约束条件如下：
s(t)＝a0+a1t+a2t2+a3t3+a4t4+a5t5
sS(0)＝0,s(t)＝
整理得一维的五次多项式插值式：
公式(1)和(2)中，Init(sf)表示初始时刻末端期望轨迹点相对于初始轨迹点的初始偏差值，tf表示规划时长，s(t)-Init(sf)的差值表示为反向规划值，即规划点相对于期望末端轨迹点的偏差；
将此算法拓展到六维，即通过对位置量(Dx,Dy,Dz)和姿态量ZYX欧拉角(Ex,Ey,Ez)进行五次多项式插值，完成视觉跟踪阶段的反向规划。
具体实施方式三：结合图1至图8说明本实施方式，本实施方式所述一种空间机械臂抓捕非合作喷管的运动规划方法的引入机械臂从ti时刻规划点向ti+1时刻规划点动作，获取两个规划点间的位姿变换矩阵矩阵/>通过矩阵/>运算得到；其中，通过相机数据获得目标相对于机械臂末端的坐标变换矩阵/>通过反向规划算法获得规划点相对于目标的坐标变换矩阵/>最终，由机械臂的正运动学、关节位置反馈qc和逆运动学，得到机械臂末端期望轨迹对应的期望关节角qd。
具体实施方式四：结合图1至图8说明本实施方式，本实施方式所述一种空间机械臂抓捕非合作喷管的运动规划方法的直接对接阶段只需对位置量(Dx)规划，其他位姿量(Dy,Dz,Ex,Ey,Ez)规划值为0，为使加速度曲线是平滑连续的，基于正弦函数分段规划了直线轨迹，算法具体形式为：
公式(4)、(5)、(6)中Amax＝(25πxf)/(8T2)为最大加速度值；xf为总的规划值，即机械臂末端坐标系X轴向的预期进给总长，T为总的规划时长。
具体实施方式五：结合图1至图8说明本实施方式，本实施方式所述一种空间机械臂抓捕非合作喷管的伺服控制方法的关节空间轨迹规划的关节参考加速度为：
公式(7)中，e＝qd-qc。
以上所述，仅是本发明的较佳实施例而已，并非对本发明作任何形式上的限制，虽然本发明已以较佳实施例揭露如上，然而并非用以限定本发明，任何熟悉本专业的技术人员，在不脱离本发明技术方案范围内，当可利用上述揭示的技术内容做出些许更动或修饰为等同变化的等效实施例，但凡是未脱离本发明技术方案内容，依据本发明的技术实质，在本发明的精神和原则之内，对以上实施例所作的任何简单的修改、等同替换与改进等，均仍属于本发明技术方案的保护范围之内。
Claims (3)
1.一种空间机械臂抓捕非合作喷管的运动规划方法，其特征在于：所述一种空间机械臂抓捕非合作喷管的运动规划方法由视觉跟踪阶段和直接对接阶段两部分组成，视觉跟踪阶段是根据目标位姿反馈，动态规划机械臂接近至翻滚卫星喷管端面的轨迹，直接对接阶段是规划机械臂沿对接方向的运动速度，在笛卡尔空间下期望轨迹仅有位置变化，无姿态调整，依赖末端执行器头部主动变形适应喷管的姿态变化；视觉跟踪阶段采用多项式插值法规划五次多项式插值算法能保障位置、速度和加速度曲线连续，其插值通式及边界约束条件如下：
s(t)＝a0+a1t+a2t2+a3t3+a4t4+a5t5
s(0)＝0，s(tf)＝sf
整理得一维的五次多项式插值式：
公式(1)和(2)中，Init(sf)表示初始时刻末端期望轨迹点相对于初始轨迹点的初始偏差值，tf表示规划时长，s(t)-Init(sf)的差值表示为反向规划值，即规划点相对于期望末端轨迹点的偏差；
将此算法拓展到六维，即通过对位置量(Dx，Dy，Dz)和姿态量ZYX欧拉角(Ex，Ey，Ez)进行五次多项式插值，完成视觉跟踪阶段的反向规划；
直接对接阶段只需对位置量(Dx)规划，其他位姿量(Dy，Dz，Ex，Ey，Ez)规划值为0，为使加速度曲线是平滑连续的，基于正弦函数分段规划了直线轨迹，算法具体形式为：
公式(4)、(5)、(6)中Amax＝(25πxf)/(8T2)为最大加速度值；xf为总的规划值，即机械臂末端坐标系X轴向的预期进给总长，T为总的规划时长。
2.根据权利要求1所述的一种空间机械臂抓捕非合作喷管的运动规划方法，其特征在于：引入机械臂从ti时刻规划点向ti+1时刻规划点动作，获取两个规划点间的位姿变换矩阵矩阵/>通过矩阵/>运算得到；其中，通过相机数据获得目标相对于机械臂末端的坐标变换矩阵/>通过反向规划算法获得规划点相对于目标的坐标变换矩阵/>最终，由机械臂的正运动学、关节位置反馈qc和逆运动学，得到机械臂末端期望轨迹对应的期望关节角qd。
3.根据权利要求1所述的一种空间机械臂抓捕非合作喷管的运动规划方法，其特征在于：关节空间轨迹规划的关节参考加速度为：
公式(7)中，e＝qd-qc。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311189954.7A CN117245653B (zh) | 2023-09-15 | 2023-09-15 | 一种空间机械臂抓捕非合作喷管的运动规划方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311189954.7A CN117245653B (zh) | 2023-09-15 | 2023-09-15 | 一种空间机械臂抓捕非合作喷管的运动规划方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117245653A CN117245653A (zh) | 2023-12-19 |
| CN117245653B true CN117245653B (zh) | 2024-06-14 |
Family
ID=89127336
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311189954.7A Active CN117245653B (zh) | 2023-09-15 | 2023-09-15 | 一种空间机械臂抓捕非合作喷管的运动规划方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117245653B (zh) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108381553A (zh) * | 2018-04-28 | 2018-08-10 | 北京空间飞行器总体设计部 | 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及*** |
| CN108408080A (zh) * | 2018-03-29 | 2018-08-17 | 南昌航空大学 | 一种飞机翼身对接装配装置、方法及*** |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106647282B (zh) * | 2017-01-19 | 2020-01-03 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
| CN114407013B (zh) * | 2022-01-19 | 2022-07-22 | 哈尔滨工业大学 | 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 |
-
2023
- 2023-09-15 CN CN202311189954.7A patent/CN117245653B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108408080A (zh) * | 2018-03-29 | 2018-08-17 | 南昌航空大学 | 一种飞机翼身对接装配装置、方法及*** |
| CN108381553A (zh) * | 2018-04-28 | 2018-08-10 | 北京空间飞行器总体设计部 | 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及*** |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117245653A (zh) | 2023-12-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108381553B (zh) | 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及*** | |
| CN109571466B (zh) | 一种基于快速随机搜索树的七自由度冗余机械臂动态避障路径规划方法 | |
| CN107490965B (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
| CN109048890B (zh) | 基于机器人的协调轨迹控制方法、***、设备及存储介质 | |
| CN101612734B (zh) | 管道喷涂机器人及其作业轨迹规划方法 | |
| CN102646148A (zh) | 仿人机器人机械臂避碰运动轨迹规划方法 | |
| CN112828359A (zh) | 基于势场法多约束的机器人铣削加工姿态规划方法和*** | |
| CN108897321A (zh) | 基于领航跟随法的机器人队形可变编队控制方法与控制器 | |
| Yang et al. | Smooth trajectory planning along Bezier curve for mobile robots with velocity constraints | |
| CN113146610A (zh) | 基于零空间避障的机械臂末端轨迹跟踪算法 | |
| Li et al. | A hybrid visual servo control method for simultaneously controlling a nonholonomic mobile and a manipulator | |
| CN111890349A (zh) | 一种四自由度机械臂运动规划方法 | |
| CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
| Mu et al. | A hybrid obstacle-avoidance method of spatial hyper-redundant manipulators for servicing in confined space | |
| CN114670191A (zh) | 一种七自由度肘偏置机械臂轨迹规划方法 | |
| Zhao et al. | Minimum base disturbance control of free-floating space robot during visual servoing pre-capturing process | |
| CN116476080A (zh) | 一种基于几何可行性的空中自动抓取作业规划方法 | |
| CN113721639B (zh) | 一种用于小型水下机器人入坞的路径规划方法及控制方法 | |
| CN117245653B (zh) | 一种空间机械臂抓捕非合作喷管的运动规划方法 | |
| Ostanin et al. | Programming by Demonstration Using Two-Step Optimization for Industrial Robot. | |
| Agah et al. | On-line robotic interception planning using a rendezvous-guidance technique | |
| CN116714780A (zh) | 一种旋翼飞行机械臂及空中快速抓取的规划和控制方法 | |
| CN116237938A (zh) | 一种基于冗余自由度利用的旋翼飞行机械臂协调运动规划方法 | |
| CN115590407A (zh) | 清洁用机械臂规划控制***、方法及清洁机器人 | |
| Liu et al. | Goal-driven motion control of snake robots with onboard cameras via policy improvement with path integrals |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |