CN114407013B - 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 - Google Patents
一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 Download PDFInfo
- Publication number
- CN114407013B CN114407013B CN202210061592.2A CN202210061592A CN114407013B CN 114407013 B CN114407013 B CN 114407013B CN 202210061592 A CN202210061592 A CN 202210061592A CN 114407013 B CN114407013 B CN 114407013B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- coordinate system
- docking ring
- capture point
- joint
- 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
Images
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
- 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
一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,涉及轨迹规划领域。本发明是为了解决现有机械臂伺服规划技术应用到失效卫星上时无法锁定失效卫星对接环的抓捕点导致跟踪过程中机械臂末端轨迹在对接环上漂移的问题。本发明包括:获取机械臂基座系相对于末端工具系的位姿矩阵eTb;获得对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg;利用eTb中机械臂基座系的姿态信息,以末端工具系为参考坐标系,重构eTg,获得重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_];基于三角函数规划机械臂末端期望路径,使[d_,γ_]在预设时间内收敛到抓捕容差内;利用机械臂末端期望路径获取机械臂细分关节轨迹。本发明用于规划机械臂伺服对接圆环的运动轨迹。
Description
技术领域
本发明涉及轨迹规划领域,特别涉及一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法。
背景技术
失效卫星没有合作的标志器,为了捕获这类卫星,在机械臂末端安装手眼相机,通过测量卫星上的典型特征获取末端工具系与目标之间的相对位姿。失效的卫星通用特征包括对接环,帆板支架,天线等。其中对接环有足够的强度,可作为末端工具的抓持接口,因此,对接环是失效卫星最为理想的伺服靶标和抓捕接口。此外,失效目标一般处于旋转耦合章动的翻滚状态,捕获这类目标对机械臂的伺服规划技术提出了巨大的挑战。
当前的机械臂伺服规划技术,主要针对合作目标,如日本的ETS-VII机械臂、美国的OrbitExpress机械臂和国际空间站机械臂等,其伺服对象往往是静止不动,因此对伺服规划的时间没有限制,另外,相机测量合作靶标可以准确锁定目标,其抓捕点坐标系与目标对象是固连的,因此,机械臂可以直接根据视觉信息的测量反馈,规划关节运动跟踪目标。但是失效卫星没有合作的标志器,且失效目标一般处于旋转耦合章动的翻滚状态。将现有技术应用到失效卫星中,一方面,翻滚卫星对接环为典型的圆特征,具有全向对称性,相机无法解算出目标的滚转状态,会导致反馈的抓捕点信息不是固定的抓捕点而是在对接圆环上滑动的动态抓捕点,导致跟踪过程中机械臂末端轨迹在对接环上漂移;另一方面,翻滚卫星与机械臂存在相对运动,机械臂无法在指定时间内完成目标的伺服跟踪就会导致目标漂出机械臂的工作空间。
发明内容
本发明目的是为了解决现有机械臂伺服规划技术应用到失效卫星上时无法锁定失效卫星对接环的抓捕点导致跟踪过程中机械臂末端轨迹在对接环上漂移的问题,同时还存在无法在指定时间内完成伺服导致目标漂出机械臂的工作空间的问题,而提出了一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法。
一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法具体过程为:
步骤一、根据机械臂关节角度信息获取机械臂基座系相对于末端工具系的位姿矩阵eTb;
所述机械臂包括7个关节;
步骤二、根据对接环抓捕点坐标系相对于末端工具系的位姿信息[d,γ],获得对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg;
其中,d是对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ是对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角;
步骤三、利用步骤一获得的eTb中机械臂基座系的姿态信息,以末端工具系为参考坐标系,重构步骤二获得的eTg,获得重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_];
其中,d_是重构后的对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ_是重构后的对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角;
步骤四、基于三角函数规划机械臂末端的期望路径,使步骤三获得的[d_,γ_]在预设时间内收敛到抓捕容差内;
步骤五、利用步骤四获得的机械臂末端的期望路径获取机械臂细分的关节轨迹;
所述机械臂细分的关节轨迹包括:关节位置矢量,关节速度矢量、关节加速度矢量。
本发明的有益效果为:
1、本发明引入了机械臂基座的位姿信息,重构了目标抓捕点,将伺服的目标位置锁定在了机械臂基座安装面的平行面与对接环所在圆的切点上,避免了机械臂跟踪翻滚卫星过程中,机械臂末端轨迹在对接环上漂移的问题,解决了相机测量全向对称的翻滚卫星对接环无法锁定目标抓捕点的问题。
2、本发明引入了时间的强约束,在指定时间内,实现了机械臂末端工具系姿态、Y、Z位置方向的位置与对接环抓捕点坐标系的对中;本发明在指定的完成伺服时间内,在X位置方向实现了末端工具系与抓捕点坐标系相对距离收敛,本发明在规划上实现了伺服时间严格可控,并保证先完成目标锁定,保证抓捕工具以最佳姿态接近目标对接环,避免了目标漂出机械臂的工作空间的问题。
附图说明
图1为机械臂坐标系;
图2为伺服规划方法中涉及到的主要坐标系;
图3为伺服规划方法流程图;
图4为机械臂伺服翻滚目标过程中的关键构型图;
其中,图4(a)是伺服初始构型图;图4(b)是伺服对中构型图;图4(c)是伺服完成构型图;
图5为机械臂伺服翻滚目标过程中末端工具系与重构抓捕点坐标系的相对位姿数据曲线图;
其中,图5(a)为相对距离数据曲线图;图5(b)为相对姿态数据曲线图;
图6为关节位置细分后得到的关节空间轨迹(位置、速度和加速度);
其中,图6(a)为细分的关节位置曲线图;图6(b)为关节速度曲线图;图6(c)是关节加速度曲线图。
具体实施方式
具体实施方式一:结合图1-2本实施方式一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法具体过程为:
步骤一、根据机械臂关节位置传感器实时反馈的关节角度信息获取机械臂基座系相对于末端工具系的位姿矩阵eTb;机械臂的关节坐标系如图1所示,对应的DH参数表如表1所示;
其中,θ为7个关节角度的矢量,l为机械臂连杆长度参数即为连杆偏距di的值,bT0为常值矩阵, eTb表示由机械臂基座系至末端工具系的位姿矩阵,e是末端工具系,b是机械臂基座系,enb,eob,eab分别表示基座系在末端系下的单位矢量,enb为基座安装面的法线矢量,epb表示基座系原点在末端系下的位置矢量,[enb,eob,eab]是机械臂基座系的姿态信息,fdkine()是正运动学求解函数;
表1机械臂DH参数表
步骤二、根据安装在机械臂末端的手眼相机反馈的对接环抓捕点坐标系相对于末端工具系的位姿信息[d,γ],获得对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg:
式中,d为手眼相机实时反馈的对接环与末端工具系之间的相对距离,γ为手眼相机实时反馈的对接环与末端工具系之间的相对姿态,eTg表示由对接环抓捕点坐标系至末端工具系的位姿矩阵,g代表对接环抓捕点坐标系,eng,eog,eag分别表示对接环抓捕点坐标系在末端工具系下的单位矢量,其中eng矢量为对接环所在平面的法线矢量,eag矢量在对接环所在平面内,并由对接环抓捕点坐标系原点指向对接环所在圆⊙O的圆心O,epg表示对接环抓捕点坐标系原点在末端工具系下的位置矢量,wz2mtrx()是位姿信息到位姿矩阵转换函数。
步骤三、利用步骤一获得的机械臂基座系的姿态信息enb、eob、eab,以末端工具系为参考坐标系,重构步骤二获得的eTg,获得重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息:
步骤三一、利用步骤一获得的机械臂基座系的姿态信息,获取重构后的对接环抓捕点坐标系在末端工具系下的姿态矩阵eRg_:
步骤三一一、将重构前对接环抓捕点坐标系的X轴矢量仍作为重构后对接环抓捕点坐标系得X轴矢量,即:
eng_=eng (3)
其中,下标g_代表重构后的对接环抓捕点坐标系,重构前的对接环抓捕点坐标系即为步骤二获得的eTg;
步骤三一二、将矢量enb与eng叉乘得到重构后的对接环抓捕点坐标系的Y轴矢量,即:
eog_=enb×eng (4)
步骤三一三、坐标系为右手系,所以重构后的对接环抓捕点坐标系的Z轴矢量为:
eag_=eng_×eog_ (5)
步骤三一四、根据步骤三一一到步骤三一三获得X、Y、Z矢量获得重构后对接环抓捕点坐标系在末端工具系下的姿态矩阵:
eRg_=[eng_ eog_ eag_] (6)
步骤三二、利用步骤三一获得的eRg_获取重构后的对接环抓捕点坐标系相对于重构前对接环抓捕点坐标系的相对姿态关系gRg_:
gRg_=[eng eog eag]T eRg_ (7)
步骤三三、利用步骤三二获得相对姿态关系gRg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg_:
步骤三三一、利用步骤三二获得的相对姿态关系gRg_获取重构前对接环抓捕点坐标系eTg转换到重构后的对接环抓捕点坐标系eRg_绕X轴旋转的角度β:
gRg_=RotX(β) (8)
其中,RotX(·)表示绕X轴旋转的单位位姿矩阵;
步骤三三二、利用β获取重构后的对接环抓捕点坐标系eRg_原点相对于重构前对接环抓捕点坐标系eTg原点的距离矢量gpg_:
gpg-=[0 rsin(β) r-rcos(β)]T (9)
其中,r是对接环半径,为已知量,[]T是转置;
步骤三三三、利用步骤三三二获得的距离矢量gpg_获取重构后的对接环抓捕点坐标系eRg_相对于末端工具系的位姿矩阵eTg_:
eTg_=eTg gTg_ (10)
其中,重构后的对接环抓捕点坐标系相对于重构前对接环抓捕点坐标系的位姿矩阵为:
步骤三四、利用eTg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_];
姿态采用ZYX欧拉角表示,作为机械臂伺服规划方法的输入:
[d_,γ_]=mtrx2wz(eTg_) (12)
其中,d_代表重构后的对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ_代表重构后的对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角,mtrx2wz()是位姿矩阵到位姿信息转换函数。
步骤四、基于三角函数规划机械臂末端的期望路径,使步骤三获得的[d_,γ_]在预设时间内收敛到抓捕容差内;
所述抓捕容差根据抓捕工具确定;
所述机械臂末端的期望路径,通过以下方式获得:
步骤四一、获取规划初始时刻t0时目标抓捕点相对于末端工具系的相对位姿偏差[dinit_,γinit_],并设定伺服开始到对准时间为tl,伺服开始到完成时间为tf;
相对位姿偏差和tl、tf均为常值,其中伺服完成时间tf应大于对准时间tl;
步骤四二、采用三角函数对步骤四一获得的[dinit_,γinit_]进行规划获得初始偏差补偿量[dc,γc]中每个元素,具体如下:
对于位置的补偿量dc中的第1个元素,即末端工具系原点与目标点在工具系X方向(前进方向)的距离补偿量,通过以下方式获取:
位置补偿量dc和姿态补偿量γc分别有三个元素;
若时间变量t<tf:
其中,时间变量t是初始时刻t0到当前时刻的经历的时间;
当时间变量t≥tf:
dc(1)=0 (14)
其中,dinit_(1)是t0时刻的位置的补偿量dinit_中的第一个元素;
对于dc中的另外两个元素以及ZYX欧拉角姿态补偿量γc:,通过以下公式获得:
若时间变量t<tl:
若时间变量t≥tl:
x=0 (16)
其中,x代表dc(2),dc(3)或γc的三个分量,xinit为对应的dinit_(2),dinit_(3)或γinit_的三个分量。
步骤四三、利用步骤四二获得的初始偏差补偿量中每个元素获得补偿初始位姿偏差的位姿矩阵Tfill-gap:
其中,RotZ(·)和RotY(·)分别表示绕Z轴和Y轴旋转的单位位姿矩阵;
步骤四四、利用步骤四三获得的Tfill-gap规划获取末端工具系的期望路径,并以末端工具系相对于机械臂基座系的位姿矩阵表示:
bTr=(eTb)-1 eTg_Tfill-gap (18)
步骤五、利用步骤四获得的机械臂末端的期望路径获取细分的关节轨迹:
步骤五一、首先选定一个关节k,基于选定的关节位置的位置级逆运动学解算期望笛卡尔位姿对应的关节角度:
θd=ikine(bTr,θk) (19)
其中,θd为解算得到的关节期望角度矢量,对应7个关节的期望角度,θk为指定的关节角度,ikine()是逆运动学求解函数,k为选定的关节标号,k取{1,2,3,5,6,7}即除最中间的关节以外的关节;
步骤五二、对θa进行二次多项式插补,得到细分的关节轨迹:
实施例:
为本发明的有效性,以下结合图3至图6对本发明的技术方案做进一步描述,使用计算机仿真。
搭建计算机仿真平台,启动伺服,具体实施步骤如附图3所示,在每一个规划周期内做如下运算:
[步骤S1]根据关节角度反馈计算eTb;
[步骤S2]根据关节角度反馈计算eTg;
[步骤S3]目标对接环半径为813.25mm,重构新的抓捕点,计算得到eTg_;
[步骤S4]从eTg_解算出新的位姿反馈[d_,γ_];
[步骤S5]判断是否首次进入伺服,若为首次进入伺服,记录下初始位姿偏差[dinit_,γinit_],否则直接进入下一步;
[步骤S6]判断伺服时间t是否已经超过设定的锁定目标时间tl,若未超过,则位置Y、Z方向以及三个姿态各自按照下列公式计算补偿量,若已经超过锁定目标时间,补偿量为0;
x代表dc(2),dc(3)或γc的三个分量,xinit为对应的dinit_(2),dinit_(3)或γinit_的三个分量。
[步骤S7]判断伺服时间t是否已经超过设定的伺服目标时间tf,若未超过,则位置X方向(机械臂前进方向)按照下列公式计算补偿量,若已经超过锁定目标时间,补偿量为0:
[步骤S8]根据补偿量[dc,γc],得到补偿初始位姿偏差的位姿矩阵:
[步骤S9]得到机械臂末端的期望路径:
bTr=(eTb)-1 eTg_Tfill-gap
[步骤S10]基于指定关节2位置的位置级逆运动学解算期望笛卡尔位姿对应的关节角度,并对其细分得到关节空间轨迹:
θd=ikine(bTr,θ2)
[步骤S11]判断是否到位,若已经伺服到位则结束规划,否则,进入下一控制周期,重回[步骤S1]继续进行规划。
Claims (8)
1.一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,其特征在于所述方法具体过程为:
步骤一、根据机械臂关节角度信息获取机械臂基座系相对于末端工具系的位姿矩阵eTb;
所述机械臂包括7个关节;
步骤二、根据对接环抓捕点坐标系相对于末端工具系的位姿信息[d,γ],获得对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg;
其中,d是对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ是对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角;
步骤三、利用步骤一获得的eTb中机械臂基座系的姿态信息,以末端工具系为参考坐标系,重构步骤二获得的eTg,获得重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_],包括以下步骤:
步骤三一、利用步骤一获得的机械臂基座系的姿态信息,获取重构后的对接环抓捕点坐标系在末端工具系下的姿态矩阵eRg_,具体包括以下步骤:
步骤三一一、将eTg的X轴矢量仍作为重构后对接环抓捕点坐标系的X轴矢量,即:
eng_=eng (3)
其中,下标g_代表重构后的对接环抓捕点坐标系;
步骤三一二、将eTb中的矢量enb与eng叉乘得到重构后的对接环抓捕点坐标系的Y轴矢量:
eog_=enb×eng (4)
步骤三一三、获取重构后的对接环抓捕点坐标系的Z轴矢量:
eag_=eng_×eog_ (5)
步骤三一四、根据步骤三一一到步骤三一三获得的重构后的对接环抓捕点坐标系X、Y、Z矢量获取重构后对接环抓捕点坐标系在末端工具系下的姿态矩阵:
eRg_=[eng_ eog_ eag_] (6)
步骤三二、利用步骤三一获得的eRg_获取重构后的对接环抓捕点坐标系相对于eTg的相对姿态关系gRg_:
gRg_=[eng eog eag]TeRg_ (7)
步骤三三、利用步骤三二获得的gRg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg_:
步骤三三一、利用步骤三二获得的gRg_,获取将eTg转换到eRg_绕X轴旋转的角度β:
gRg_=RotX(β) (8)
其中,RotX(·)表示绕X轴旋转的单位位姿矩阵;
步骤三三二、利用β获取eRg_原点与eTg原点之间的距离矢量gpg_:
gpg_=[0 rsin(β) r-rcos(β)]T (9)
其中,r是对接环半径,[]T是转置;
步骤三三三、利用步骤三三二获得的gpg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿矩阵eTg_:
eTg_=eTg gTg_ (10)
其中,重构后的对接环抓捕点坐标系相对于eTg的位姿矩阵gTg_为:
步骤三四、利用步骤三三获得的eTg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_];
其中,d_是重构后的对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ_是重构后的对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角;
步骤四、基于三角函数规划机械臂末端的期望路径,使步骤三获得的[d_,γ_]在预设时间内收敛到抓捕容差内;
基于三角函数规划机械臂末端的期望路径,通过以下方式实现:
步骤四一、获取规划初始时刻t0时目标抓捕点相对于末端工具系的相对位姿偏差[dinit_,γinit_],并设定伺服开始到对准时间tl,伺服开始到完成时间tf;
其中,tl、tf均为常值且tf>tl;
步骤四二、采用三角函数对步骤四一获得的[dinit_,γinit_]进行规划获得初始偏差补偿量[dc,γc]中每个元素,具体如下:
首先,位置的补偿量dc中的第1个元素,通过以下公式获得:
若时间变量t<tf,则:
其中,时间变量t是初始时刻t0到当前时刻的经历的时间;
若时间变量t≥tf,则:
dc(1)=0 (14)
其中,dinit_(1)是t0时刻的位置的补偿量dinit_中的第一个元素;
然后,dc中的另外两个元素以及姿态补偿量γc中的三个元素,通过以下公式获得:
若时间变量t<tl,则:
若时间变量t≥tl:
x=0 (16)
其中,x是dc中第二个元素dc(2)、dc中第三个元素dc(3)或γc中的三个元素,xinit为对应的dinit_(2)、dinit_(3)或γinit_中的三个元素;
步骤四三、利用步骤四二获得的初始偏差补偿量中每个元素获得补偿初始位姿偏差的位姿矩阵Tfill-gap:
其中,RotZ(·)和RotY(·)分别表示绕Z轴和Y轴旋转的单位位姿矩阵;
步骤四四、利用步骤四三获得的Tfill-gap获取末端工具系的期望路径:
bTr=(eTb)-1eTg_Tfill-gap (18);
步骤五、利用步骤四获得的机械臂末端的期望路径获取机械臂细分的关节轨迹;
所述机械臂细分的关节轨迹包括:关节位置矢量,关节速度矢量、关节加速度矢量。
2.根据权利要求1所述的一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,其特征在于:所述机械臂关节角度信息通过机械臂关节位置传感器获得。
3.根据权利要求1所述的一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,其特征在于:所述对接环抓捕点坐标系相对于末端工具系的位姿信息通过安装在机械臂末端的手眼相机获得。
6.根据权利要求5所述的一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,其特征在于:所述步骤三四中利用步骤三三获得的eTg_获取重构后的对接环抓捕点坐标系相对于末端工具系的位姿信息[d_,γ_]采用ZYX欧拉角表示,具体如下:
[d_,γ_]=mtrx2wz(eTg_) (12)
其中,d_代表重构后的对接环抓捕点坐标系原点在末端工具系下的位置矢量,γ_代表重构后的对接环抓捕点坐标系相对于末端工具系的ZYX欧拉角,mtrx2wz()是位姿矩阵到位姿信息转换函数。
7.根据权利要求6所述的一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法,其特征在于:所述步骤五中的利用步骤四获得的机械臂末端的期望路径获取机械臂细分的关节轨迹,包括以下步骤:
步骤五一、首先选定机械臂的一个关节k,基于选定的关节位置的位置级逆运动学解算期望笛卡尔位姿对应的关节角度θd:
θd=ikine(bTr,θk) (19)
其中,θd为解算得到的关节期望角度矢量,对应7个关节的期望角度,θk为指定关节的角度,ikine()是逆运动学求解函数,k为选定的关节标号取{1,2,3,5,6,7};
步骤五二、对θd进行二次多项式插补,得到细分的关节轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210061592.2A CN114407013B (zh) | 2022-01-19 | 2022-01-19 | 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210061592.2A CN114407013B (zh) | 2022-01-19 | 2022-01-19 | 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114407013A CN114407013A (zh) | 2022-04-29 |
CN114407013B true CN114407013B (zh) | 2022-07-22 |
Family
ID=81275759
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210061592.2A Active CN114407013B (zh) | 2022-01-19 | 2022-01-19 | 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114407013B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116442233B (zh) * | 2023-04-28 | 2024-04-12 | 哈尔滨工业大学 | 一种七自由度空间机械臂在轨操作的手眼标定方法 |
CN117245653B (zh) * | 2023-09-15 | 2024-06-14 | 哈尔滨工业大学 | 一种空间机械臂抓捕非合作喷管的运动规划方法 |
CN117532616A (zh) * | 2023-12-18 | 2024-02-09 | 浙江大学 | 冗余液压机械臂的主从异构相似性映射控制方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4664344A (en) * | 1985-11-07 | 1987-05-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Apparatus and method of capturing an orbiting spacecraft |
US4942538A (en) * | 1988-01-05 | 1990-07-17 | Spar Aerospace Limited | Telerobotic tracker |
CN106625671A (zh) * | 2016-12-27 | 2017-05-10 | 西北工业大学 | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 |
CN106892137A (zh) * | 2017-02-21 | 2017-06-27 | 哈尔滨工业大学深圳研究生院 | 一种空间非合作翻滚目标的大容差捕获方法及*** |
CN109048890A (zh) * | 2018-07-13 | 2018-12-21 | 哈尔滨工业大学(深圳) | 基于机器人的协调轨迹控制方法、***、设备及存储介质 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7240879B1 (en) * | 2005-05-06 | 2007-07-10 | United States of America as represented by the Administration of the National Aeronautics and Space Administration | Method and associated apparatus for capturing, servicing and de-orbiting earth satellites using robotics |
-
2022
- 2022-01-19 CN CN202210061592.2A patent/CN114407013B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4664344A (en) * | 1985-11-07 | 1987-05-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Apparatus and method of capturing an orbiting spacecraft |
US4942538A (en) * | 1988-01-05 | 1990-07-17 | Spar Aerospace Limited | Telerobotic tracker |
CN106625671A (zh) * | 2016-12-27 | 2017-05-10 | 西北工业大学 | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 |
CN106892137A (zh) * | 2017-02-21 | 2017-06-27 | 哈尔滨工业大学深圳研究生院 | 一种空间非合作翻滚目标的大容差捕获方法及*** |
CN109048890A (zh) * | 2018-07-13 | 2018-12-21 | 哈尔滨工业大学(深圳) | 基于机器人的协调轨迹控制方法、***、设备及存储介质 |
Non-Patent Citations (2)
Title |
---|
基于星箭对接环同心圆结构的卫星姿态估计方法;鄂薇等;《航天器工程》;20180415(第02期);全文 * |
空间机器人捕获非合作目标的测量与规划方法;徐文福等;《机器人》;20100115(第01期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114407013A (zh) | 2022-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114407013B (zh) | 一种机械臂伺服翻滚卫星对接圆环的运动轨迹规划方法 | |
CN109606753B (zh) | 一种空间双臂机器人协同抓捕目标的控制方法 | |
CN111300422B (zh) | 基于视觉图像的机器人工件抓取位姿误差补偿方法 | |
CN111367236B (zh) | 一种面向加工过程的移动机器人***标定方法及*** | |
CN113001535B (zh) | 机器人工件坐标系自动校正***与方法 | |
CN106166749B (zh) | 一种空间移动多臂机器人的移动轨迹规划方法 | |
CN109877840B (zh) | 一种基于相机光轴约束的双机械臂标定方法 | |
CN105823417B (zh) | 一种基于摄影测量提高激光跟踪仪转站精度的方法 | |
CN114310915B (zh) | 基于视觉反馈的空间机械臂对接末端工具轨迹规划方法 | |
CN106864776B (zh) | 一种基于对接环的捕获目标卫星的方法与*** | |
CN114670191B (zh) | 一种七自由度肘偏置机械臂轨迹规划方法 | |
CN110900610B (zh) | 一种基于lm算法和粒子滤波算法优化的工业机器人标定方法 | |
CN110039548B (zh) | 一种拼装机控制方法、装置及设备 | |
CN110480638A (zh) | 一种多关节机器人位姿误差自补偿的码垛方法及其码垛*** | |
CN112454366A (zh) | 一种手眼标定方法 | |
CN116100550A (zh) | 基于双环力位耦合协同控制的多机器人模仿学习装配方法 | |
CN113263498B (zh) | 机械臂移动控制方法、装置、终端设备及存储介质 | |
CN111673739A (zh) | 一种基于rbf神经网络的机器人位姿可达性判断的方法 | |
CN116587289B (zh) | 一种七自由度腕关节偏置机械臂逆解方法、***及介质 | |
CN112476435B (zh) | 重力加速度方向的标定方法、标定装置及存储介质 | |
CN117301064A (zh) | 一种基于固定时间收敛的双臂机器人安全协同控制方法 | |
CN116652953A (zh) | 一种机器人末端模型动态接触力测量的误差补偿与处理方法 | |
CN113878586B (zh) | 机器人运动学标定装置、方法及*** | |
Shi et al. | Study on intelligent visual servoing of space robot for cooperative target capturing | |
CN115416030B (zh) | 一种机械臂远距离跟踪翻滚卫星对接环的运动规划方法 |
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 |