CN109093620B - 一种双目相机辅助的空间非合作目标动力学参数辨识方法 - Google Patents

一种双目相机辅助的空间非合作目标动力学参数辨识方法 Download PDF

Info

Publication number
CN109093620B
CN109093620B CN201810822003.1A CN201810822003A CN109093620B CN 109093620 B CN109093620 B CN 109093620B CN 201810822003 A CN201810822003 A CN 201810822003A CN 109093620 B CN109093620 B CN 109093620B
Authority
CN
China
Prior art keywords
target
acceleration
joint
vector
arm
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
Application number
CN201810822003.1A
Other languages
English (en)
Other versions
CN109093620A (zh
Inventor
袁建平
车德佳
宁昕
侯翔昊
马川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201810822003.1A priority Critical patent/CN109093620B/zh
Publication of CN109093620A publication Critical patent/CN109093620A/zh
Application granted granted Critical
Publication of CN109093620B publication Critical patent/CN109093620B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/1602—Programme controls characterised by the control system, structure, architecture

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种双目相机辅助的空间非合作目标动力学参数辨识方法，根据本体加速度、角加速度、关节角以及服务卫星的本体几何特征，通过积分、微分，求取在惯性参考系下的本体速度、角速度、关节角速度以及关节位置速度；由动力学公式计算服务卫星在接触点所受外力大小，即为服务卫星对目标施加力的反力；构建目标的模型，在目标固有参考系下构建力与加速度的关系等式；循环进行多次采样，利用最小二乘优化法获得目标的参数，完成空间非合作目标动力学参数辨识。本方法能在非合作目标‑末端执行器接触点存在相对运动的情况下对非合作目标质量特征参数进行精确的辨识，且能够降低噪音的影响，并具有计算量较小的优点。

Description

一种双目相机辅助的空间非合作目标动力学参数辨识方法
技术领域
本发明属于航天技术领域，具体涉及一种双目相机辅助的空间非合作目标动力学参数辨识方法。
背景技术
随着航天技术的发展，在轨服务技术日益受到人们的关注，在轨服务最关键的一项技术是空间机器人对非合作目标的抓捕，它是空间碎片移除、故障卫星维修、失效卫星再利用等一系列任务的基础技术。空间非合作目标抓捕分为三个阶段——抓捕前逼近、碰撞、抓捕后稳定。在第三个阶段，装备有空间机械臂的服务卫星需要完成组合体稳定，而抓捕前对非合作目标的运动学重建以及参数估计已经无法满足精确控制的要求，因此需要在抓捕后对非合作目标完成进一步的动力学参数辨识，从而为服务星-目标星组合体的稳定控制提供良好的基础。
针对空间非合作目标抓捕设计的通用抓捕机构，很难实现对未知的抓捕点的完全稳固抓捕，尤其是利用单臂空间机器人的抓捕，极易出现抓捕后非合作目标相对空间机器人末端执行器滑动的现象。常规的参数辨识方法假定接触点是牢固的，若在出现接触点滑动的情况下继续采用常规的参数辨识方法，估算的参数将会出现极大的误差，从而导致稳定控制器失效，最终产生组合体翻滚的现象。
发明内容
本发明所要解决的技术问题在于针对上述现有技术中的不足，提供一种双目相机辅助的空间非合作目标动力学参数辨识方法，将双目相机的运动重建引入参数辨识中，提高参数辨识的精度。
本发明采用以下技术方案：
一种双目相机辅助的空间非合作目标动力学参数辨识方法，包括以下步骤：
S1、利用星上加速计、陀螺仪测量服务卫星本体的加速度
Figure GDA0002391890890000021
角加速度
Figure GDA0002391890890000022
利用编码器测量机械臂关节角θi，i＝1:N,N＝6；
S2、利用双目相机计算目标固有坐标系相对末端执行器固有坐标系的方向余弦矩阵，以及某个特征点相对接触点的坐标；
S3、根据本体加速度、角加速度、关节角以及服务卫星的本体几何特征，通过积分、微分，求取在惯性参考系下的本体速度、角速度、关节角速度以及关节位置速度；
S4、由动力学公式计算服务卫星在接触点所受外力大小，即为服务卫星对目标施加力的反力；
S5、构建目标的模型，在目标固有参考系下构建力与加速度的关系等式；
S6、循环进行多次采样，利用最小二乘优化法获得目标的参数，完成空间非合作目标动力学参数辨识。
具体的，步骤S2中，通过旋转矩阵U(t)RU(t+Δt)与平移矩阵U(t)TU(t+Δt)检验目标与末端执行器是否存在位移，双目相机预先测量在N关节本体坐标系中，接触点相对相机的位置，即NrS,W，并实时计算在N关节本体坐标系中，人工设定目标固有坐标系原点相对相机的位置，即
Figure GDA0002391890890000023
进一步的，利用左右双相机分别在时刻t和t+Δt同时采集两组图像，通过同一时刻左右两图像间同一特征以及相位坐标分别求取同一点在时刻t和t+Δt的三维坐标P和P′；利用Np(Np≥3)个不共面的点在时刻t和t′的坐标(Pi,Pi′)，旋转矩阵U(t)RU(t+Δt)与平移矩阵U(t)TU(t+Δt)如下：
Figure GDA0002391890890000024
具体的，步骤S3中，根据已知的基座基点加速度
Figure GDA0002391890890000025
基座角加速度
Figure GDA0002391890890000026
基座基点到质心矢量a0，基座质心到关节矢量b0，i关节指向i臂质心矢量ai，i臂质心指向i+1关节的矢量bi，i关节的关节角θi(i＝1:N,N＝6)，以及相应的初始条件，根据运动学公式求得基座基点坐标p0，基座基点
Figure GDA0002391890890000031
基座质心坐标r0，基座质心线速度
Figure GDA0002391890890000032
基座质心线加速度
Figure GDA0002391890890000033
基座相对惯性参考系余弦坐标矩阵IR0，基座角速度ω0，i关节坐标pi，i关节线速度
Figure GDA0002391890890000034
i关节线加速度
Figure GDA0002391890890000035
i臂质心坐标ri，i臂线质心速度
Figure GDA0002391890890000036
i臂质心线加速度
Figure GDA0002391890890000037
i臂本体坐标系相对于惯性坐标系的余弦坐标矩阵IRi，i关节旋转角速度
Figure GDA0002391890890000038
i关节角加速度
Figure GDA0002391890890000039
接触点坐标pW，接触点线速度
Figure GDA00023918908900000310
接触点线加速度
Figure GDA00023918908900000311
具体的，步骤S4中，接触点的力与力矩计算如下：
Figure GDA00023918908900000312
其中，fU为非合作目标所受外力，nU为非合作目标所受外力矩，mi为i臂质量，
Figure GDA00023918908900000313
为i臂质心线加速度，Ii为i臂转动惯量，ωi为i臂角速度，pW为接触点坐标，ri为i臂质心坐标，N为机械臂关节总数。
具体的，步骤S5中，根据力与加速度的关系等式得到非合作目标质量mU，在目标固有坐标系下基点指向质心的矢量
Figure GDA00023918908900000314
在目标固有坐标系下目标转动惯量UIU的参数，力与加速度的关系等式如下：
Figure GDA00023918908900000315
其中，矢量左上标有U表示该矢量表示在目标固有坐标系下，rSW为相机指向接触点的矢量，
Figure GDA00023918908900000316
是相机指向接触点的矢量，
Figure GDA00023918908900000317
为目标本体坐标基点线加速度，向量右上角为叉乘变换，若
Figure GDA0002391890890000041
则有
Figure GDA0002391890890000042
Figure GDA0002391890890000043
具体的，步骤S6中，将时间k时刻带入力与加速度的关系等式，在辨识阶段的采样次数一共为Nk，得到minΔ，最终求出非合作目标的参数minΔ如下：
Figure GDA0002391890890000044
Figure GDA0002391890890000045
Figure GDA0002391890890000046
Figure GDA0002391890890000047
其中，矢量左上标有U表示该矢量表示在目标固有坐标系下，rSW为相机指向接触点的矢量，
Figure GDA0002391890890000048
是相机指向接触点的矢量，
Figure GDA0002391890890000049
为目标本体坐标基点线加速度，向量右上角为叉乘变换，mU为非合作目标质量，fU为非合作目标所受外力，nU为非合作目标所受外力矩，
Figure GDA0002391890890000051
与现有技术相比，本发明至少具有以下有益效果：
本发明针对空间机器人末端执行器-非合作目标之间的相对滑动，提出了双目相机辅助的空间非合作目标的动力学参数辨识方法，对相对滑动的分析符合工程实际，计算具有实时性、快速性，且通过多次取样计算，利用最优化算法降低因测量误差导致的结果误差。
进一步的，利用双目相机计算目标固有坐标系相对末端执行器固有坐标系的方向余弦矩阵，以及某个特征点相对接触点的坐标，目的是：1)检测目标与末端执行器是否存在相对滑动或者相对转动；2)确定目标与末端执行器之间存在相对滑动或者相对转动时，利用滤波算法计算得到精确的相对运动信息。该步骤可以避免相对位移对后续的参数辨识带来不可预知的影响，从而大大提高辨识精度。
进一步的，根据本体加速度、角加速度、关节角以及服务卫星的本体几何特征，通过积分、微分，求取在惯性参考系下的本体速度、角速度、关节角速度以及关节位置速度。该步骤目的是利用星敏感器以及空间机器人固有构型得到关节、质心的位置、速度以及加速度。该步骤快速可靠。
进一步的，由动力学公式计算服务卫星在接触点所受外力大小，即为服务卫星对目标施加力的反力。该步骤目的是利用星敏感器以及固有质量参数得到目标所受力与力矩之和。该方法避免使用易导致结构振动的力矩传感器，而利用卫星惯性导航***的数据，具有很好的稳定性。
进一步的，构建目标的模型，在目标固有参考系下构建力与加速度的关系等式。该步骤目的是通过欧拉牛顿法建立目标的动力学模型，并在动力学方程中提取非合作目标的质量参数。该方法计算精度高，且计算量较小。
进一步的，循环进行多次采样，利用最小二乘优化法获得目标的参数，完成空间非合作目标动力学参数辨识。该方法目的是降低观测误差带来的噪音。优势是采用最小二乘法计算量小，能大幅提高参数准确性。
综上所述，本方法能在非合作目标-末端执行器接触点存在相对运动的情况下对非合作目标质量特征参数进行精确的辨识，且能够降低噪音的影响，并具有计算量较小的优点。
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
附图说明
图1为非合作目标-机械臂-卫星基座组合体示意图；
图2为机械臂-卫星基座的在惯性参考系下的运动关系以及受力状态图；
图3为末端执行器与非合作目标的几何关系图。
其中：0.卫星基座；1.第一机器人臂；2.第二机器人臂；3.第三机器人臂；4.第四机器人臂；5.第五机器人臂；6.第六机器人臂；7.非合作目标；8.机器人关节；9.双目相机；10.末端执行器。
具体实施方式
在本发明的描述中，需要理解的是，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中，除非另有说明，“多个”的含义是两个或两个以上。
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本发明中的具体含义。
本发明以安装在N臂上的双目相机为例，但实际不仅限于安装在N臂，可以安装在任一一个臂上，或者卫星基座，原因是无论安装在卫星哪个位置，其辨识原理与该方法具有一致性，仅需对给出算法做简单修改。
本发明提供了一种双目相机辅助的空间非合作目标动力学参数辨识方法，空间机器人完成对非合作目标抓捕后，其抓捕点一般存在多个自由度的滑动或转动，需要考虑力约束，基于传统测量信息输入的参数辨识方法误差大，无法支持后续操控任务开展。针对这个问题，本发明基于双目视觉信息估算抓捕完成后目标滑动和转动造成的相对位姿扰动，与星敏测量参数融合后，作为运动参数输入参数辨识算法，解算得到精确、可信的非合作目标质量特性参数。
请参阅图1，非合作目标-机械臂-卫星基座组合体包括卫星基座0，非合作目标7和双目相机9，卫星基座0与非合作目标7之间依次设置有第一机器人臂1、第二机器人臂2、第三机器人臂3、第四机器人臂4、第五机器人臂5和第六机器人臂6，每个机器人臂之间均通过机器人关节8连接，第六机器人臂6通过末端执行器10与非合作目标7连接，双目相机9设置在第六机器人臂6上。
本发明一种双目相机辅助的空间非合作目标动力学参数辨识方法，包括以下步骤：
S1、利用星上加速计、陀螺仪测量服务卫星本体的加速度
Figure GDA0002391890890000071
角加速度
Figure GDA0002391890890000072
利用编码器测量机械臂关节角θi，i＝1:N,N＝6；
S2、利用双目相机计算目标固有坐标系相对末端执行器固有坐标系的方向余弦矩阵，以及某个特征点相对接触点的坐标；
双目相机于固定在服务卫星上，本发明以固定在末端执行器上的双目相机为例，利用双目相机计算目标固有坐标系相对末端执行器固有坐标系的方向余弦矩阵，以及选取某一特征点，测量其三维坐标。
Co1RCo2表示Co1坐标系相对于Co2坐标系的余弦坐标矩阵，Co1TCo2表示Co1坐标系相对于Co2坐标系的平移向量，向量左上标为I即为在惯性坐标系下表述，左上标为i即为在i臂本体坐标系下表述，左上标为N即为在N臂本体坐标系下表述，左上标为U即为在目标本体坐标系下表述。
利用左右双相机分别在时刻t和t+Δt同时采集两组图像，通过同一时刻左右两图像间同一特征以及它们的相位坐标分别求取同一点在时刻t和t+Δt的三维坐标P和P′；利用Np(Np≥3)个不共面的点在时刻t和t′的坐标(Pi,Pi′)，可以通过下式找到旋转矩阵R与平移矩阵T。
Pi′＝U(t)RU(t+Δt)Pi+U(t)TU(t+Δt) (1)
则通过
Figure GDA0002391890890000081
获得上述公式旋转矩阵U(t)RU(t+Δt)与平移向量U(t)TU(t+Δt)，通过这两个矩阵可以检验目标与末端执行器是否存在位移。
同时，如图3所示，双目相机预先测量NrS,W，即接触点相对相机的相对位置，并实时计算
Figure GDA0002391890890000082
本步骤可检验抓捕目标与末端执行器之间是否存在相对转动、平动。
S3、根据本体加速度、角加速度、关节角以及服务卫星的本体几何特征，通过积分、微分，求取在惯性参考系下的本体速度、角速度、关节角速度以及关节位置速度；
由已知的基座基点加速度
Figure GDA0002391890890000083
基座角加速度
Figure GDA0002391890890000084
基座基点到质心矢量a0，基座质心到关节矢量b0，i关节指向i臂质心矢量ai，i臂质心指向i+1关节的矢量bi，i关节的关节角θi(i＝1:N,N＝6)，以及相应的初始条件，根据运动学公式可以求得基座基点坐标p0，基座基点
Figure GDA0002391890890000085
基座质心坐标r0，基座质心线速度
Figure GDA0002391890890000086
基座质心线加速度
Figure GDA0002391890890000087
基座相对惯性参考系余弦坐标矩阵IR0，基座角速度ω0，i关节坐标pi，i关节线速度
Figure GDA0002391890890000088
i关节线加速度
Figure GDA0002391890890000089
i臂质心坐标ri，i臂线质心速度
Figure GDA00023918908900000810
i臂质心线加速度
Figure GDA00023918908900000811
i臂本体坐标系相对于惯性坐标系的余弦坐标矩阵IRi，i关节旋转角速度
Figure GDA0002391890890000091
i关节角加速度
Figure GDA0002391890890000092
接触点坐标pW，接触点线速度
Figure GDA0002391890890000093
接触点线加速度
Figure GDA0002391890890000094
S4、由动力学公式计算服务卫星在接触点所受外力大小，即为服务卫星对目标施加力的反力；
由于卫星基座、机械臂的质量、质心位置、惯性参数均为已知参数，则由动力学方程求接触点的力与力矩
Figure GDA0002391890890000095
其中，fU为非合作目标所受外力，nU为非合作目标所受外力矩，mi为i臂质量，
Figure GDA0002391890890000096
为i臂质心线加速度，Ii为i臂转动惯量，ωi为i臂角速度，pW为接触点坐标，ri为i臂质心坐标，N为机械臂关节总数。
S5、构建目标的模型，在目标固有参考系下构建力与加速度的关系等式；
由
Figure GDA0002391890890000097
其中，rU为非合作目标质心在惯性系下的坐标向量，有
rU＝pW-rCW (5)
其中
Figure GDA0002391890890000098
考虑到坐标变换，有
IRU(t)＝IRN(t) N(t)RU(t) (7)
Figure GDA0002391890890000099
Figure GDA0002391890890000101
ωE,U为目标相对于末端执行器的角速度，则
UωU＝URI IωN+UωN,U (10)
IωN即为N臂在惯性空间中的角速度，在上文中写作ωN。
则IpW、NrSW、
Figure GDA0002391890890000102
及其对时间的一二阶导数均可推算，通过IRU(t)、NRU(t)的坐标变换到ΣU(t)中，从而可得
Figure GDA0002391890890000103
其中
Figure GDA0002391890890000104
且有
Figure GDA0002391890890000105
则根据公式(11)(13)可以得到mU，
Figure GDA0002391890890000106
UIU的参数。
其中，矢量左上标有U表示该矢量表示在目标固有坐标系下，rSW为相机指向接触点的矢量，
Figure GDA0002391890890000107
是相机指向接触点的矢量，
Figure GDA0002391890890000108
为目标本体坐标基点线加速度。另外，向量右上角为叉乘变换，即
Figure GDA0002391890890000109
Figure GDA00023918908900001010
Figure GDA0002391890890000111
Figure GDA0002391890890000112
S6、循环进行多次采样，利用最小二乘优化法获得目标的参数。
将在时间为k时刻的(11)(13)写作
Ak＝BkC (14)
在辨识阶段的采样次数一共为Nk，则有
Figure GDA0002391890890000113
Figure GDA0002391890890000114
Figure GDA0002391890890000115
Figure GDA0002391890890000116
最终求出非合作目标的参数。
本发明首次考虑到空间机器人与非合作目标之间的相对滑动进行动力学参数辨识的研究，并将双目相机的运动重建引入参数辨识算法中，接触点滑动的本质是空间机器人末端执行器与非合作目标之间不再是单一的位置约束，而是变为位置/力混合约束甚至单一力约束，这个是目前的研究所忽略的方面。
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。通常在此处附图中的描述和所示的本发明实施例的组件可以通过各种不同的配置来布置和设计。因此，以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图2，图2为卫星基座-机械臂结构示意图，展示了卫星各部分本体坐标系基点、质心、以及固有构型与速度之间的关系。在基座的惯性元件可以测量基座基点加速度
Figure GDA0002391890890000121
基座角加速度
Figure GDA0002391890890000122
而每个关节所安装的电位计可以测量i关节的关节角θi(i＝1:N,N＝6)，根地面测量的基座基点到质心矢量a0，基座质心到关节矢量b0，i关节指向i臂质心矢量ai，i臂质心指向i+1关节的矢量bi，以及位置和速度的初始条件，根据经典的D-H建模方法的运动学公式可以求得基座基点坐标p0，基座基点
Figure GDA0002391890890000123
基座质心坐标r0，基座质心线速度
Figure GDA0002391890890000124
基座质心线加速度
Figure GDA0002391890890000125
基座相对惯性参考系余弦坐标矩阵IR0，基座角速度ω0，i关节坐标pi，i关节线速度
Figure GDA0002391890890000126
i关节线加速度
Figure GDA0002391890890000127
i臂质心坐标ri，i臂线质心速度
Figure GDA0002391890890000128
i臂质心线加速度
Figure GDA0002391890890000129
i臂本体坐标系相对于惯性坐标系的余弦坐标矩阵IRi，i关节旋转角速度
Figure GDA00023918908900001210
i关节角加速度
Figure GDA00023918908900001211
接触点坐标pW，接触点线速度
Figure GDA00023918908900001212
接触点线加速度
Figure GDA00023918908900001213
请参阅图3，图3为目标-相机-N臂位置关系。考虑到相机安装于N臂上，因而，相机与N臂之间余弦坐标矩阵为单位矩阵，rSW在N臂本体坐标系下是时不变的，因而可以在地面得到精确的测量值。相机需要精确地测量
Figure GDA00023918908900001214
即相机指向目标基点的矢量，并结合双目相机对目标姿态的变化，得到目标相对N臂的姿态角变化或者余弦坐标矩阵随时间变化的情况。从而补偿因滑动导致的运动信息损失的情况。
以上内容仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明权利要求书的保护范围之内。

Claims (5)

1.一种双目相机辅助的空间非合作目标动力学参数辨识方法，其特征在于，包括以下步骤：
S1、利用星上加速计、陀螺仪测量服务卫星本体的加速度
Figure FDA0002425234370000015
角加速度
Figure FDA0002425234370000016
利用编码器测量机械臂关节角θi，i＝1:N,N＝6；
S2、利用双目相机计算目标固有坐标系相对末端执行器固有坐标系的方向余弦矩阵，以及某个特征点相对接触点的坐标，通过旋转矩阵U(t)RU(t+Δt)与平移矩阵U(t)TU(t+Δt)检验目标与末端执行器是否存在位移，双目相机预先测量在N关节本体坐标系中，接触点相对相机的位置，即NrS,W，并实时计算在N关节本体坐标系中，人工设定目标固有坐标系原点相对相机的位置，即
Figure FDA0002425234370000011
利用左右双相机分别在时刻t和t+Δt同时采集两组图像，通过同一时刻左右两图像间同一特征以及相位坐标分别求取同一点在时刻t和t+Δt的三维坐标P和P′；利用Np个不共面的点在时刻t和t′的坐标(Pi,Pi′)，Np≥3，旋转矩阵U(t)RU(t+Δt)与平移矩阵U(t)TU(t+Δt)为：
Figure FDA0002425234370000012
S3、根据本体加速度、角加速度、关节角以及服务卫星的本体几何特征，通过积分、微分，求取在惯性参考系下的本体速度、角速度、关节角速度以及关节位置速度；
S4、由动力学公式计算服务卫星在接触点所受外力大小，即为服务卫星对目标施加力的反力；
S5、构建目标的模型，在目标固有坐标系下构建力与加速度的关系等式；
S6、循环进行多次采样，利用最小二乘优化法获得目标的参数，完成空间非合作目标动力学参数辨识。
2.根据权利要求1所述的一种双目相机辅助的空间非合作目标动力学参数辨识方法，其特征在于，步骤S3中，根据已知的基座基点加速度
Figure FDA0002425234370000013
基座角加速度
Figure FDA0002425234370000014
基座基点到质心矢量a0，基座质心到关节矢量b0，i关节指向i臂质心矢量ai，i臂质心指向i+1关节的矢量bi，i关节的关节角θi，i＝1:N,N＝6，以及相应的初始条件，根据运动学公式求得基座基点坐标p0，基座基点
Figure FDA0002425234370000021
基座质心坐标r0，基座质心线速度
Figure FDA0002425234370000022
基座质心线加速度
Figure FDA0002425234370000023
基座相对惯性参考系余弦坐标矩阵IR0，基座角速度ω0，i关节坐标pi，i关节线速度
Figure FDA0002425234370000024
i关节线加速度
Figure FDA0002425234370000025
i臂质心坐标ri，i臂线质心速度
Figure FDA0002425234370000026
i臂质心线加速度
Figure FDA0002425234370000027
i臂本体坐标系相对于惯性参考系的余弦坐标矩阵IRi，i关节旋转角速度
Figure FDA0002425234370000028
i关节角加速度接触点坐标pW，接触点线速度
Figure FDA00024252343700000210
接触点线加速度
Figure FDA00024252343700000211
3.根据权利要求1所述的一种双目相机辅助的空间非合作目标动力学参数辨识方法，其特征在于，步骤S4中，接触点的力与力矩计算为：
Figure FDA00024252343700000212
其中，fU为非合作目标所受外力，nU为非合作目标所受外力矩，mi为i臂质量，
Figure FDA00024252343700000213
为i臂质心线加速度，Ii为i臂转动惯量，ωi为i臂角速度，pW为接触点坐标，ri为i臂质心坐标，N为机械臂关节总数。
4.根据权利要求1所述的一种双目相机辅助的空间非合作目标动力学参数辨识方法，其特征在于，步骤S5中，根据力与加速度的关系等式得到非合作目标质量mU，在目标固有坐标系下基点指向质心的矢量
Figure FDA00024252343700000214
在目标固有坐标系下目标转动惯量UIU的参数，力与加速度的关系等式为：
Figure FDA00024252343700000215
Figure FDA00024252343700000216
其中，矢量左上标有U表示该矢量表示在目标固有坐标系下，rSW为相机指向接触点的矢量，
Figure FDA0002425234370000031
是相机指向接触点的矢量，
Figure FDA0002425234370000032
为目标本体坐标基点线加速度，向量右上角为叉乘变换，若
Figure FDA0002425234370000033
则有
Figure FDA0002425234370000034
Figure FDA0002425234370000035
Figure FDA0002425234370000036
5.根据权利要求1所述的一种双目相机辅助的空间非合作目标动力学参数辨识方法，其特征在于，步骤S6中，将时间k时刻带入力与加速度的关系等式，在辨识阶段的采样次数一共为Nk，得到minΔ，最终求出非合作目标的参数minΔ为：
Figure FDA0002425234370000037
Figure FDA0002425234370000038
Figure FDA0002425234370000039
Figure FDA0002425234370000041
其中，矢量左上标有U表示该矢量表示在目标固有坐标系下，rSW为相机指向接触点的矢量，
Figure FDA0002425234370000042
是相机指向接触点的矢量，
Figure FDA0002425234370000043
为目标本体坐标基点线加速度，向量右上角为叉乘变换，mU为非合作目标质量，fU为非合作目标所受外力，nU为非合作目标所受外力矩，
Figure FDA0002425234370000044
CN201810822003.1A 2018-07-24 2018-07-24 一种双目相机辅助的空间非合作目标动力学参数辨识方法 Active CN109093620B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810822003.1A CN109093620B (zh) 2018-07-24 2018-07-24 一种双目相机辅助的空间非合作目标动力学参数辨识方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810822003.1A CN109093620B (zh) 2018-07-24 2018-07-24 一种双目相机辅助的空间非合作目标动力学参数辨识方法

Publications (2)

Publication Number Publication Date
CN109093620A CN109093620A (zh) 2018-12-28
CN109093620B true CN109093620B (zh) 2020-07-24

Family

ID=64847366

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810822003.1A Active CN109093620B (zh) 2018-07-24 2018-07-24 一种双目相机辅助的空间非合作目标动力学参数辨识方法

Country Status (1)

Country Link
CN (1) CN109093620B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110081906B (zh) * 2019-03-28 2022-11-22 西北工业大学 基于吸附过程的非合作目标惯性特征参数的两步辨识方法
CN110361001B (zh) * 2019-06-20 2023-04-07 河北工业大学 一种用于空间碎片运动测量***及标定方法
CN112497240B (zh) * 2020-11-24 2022-12-06 西北工业大学 非刚性抓捕的目标状态观测方法、计算机设备及存储介质
CN113060309B (zh) * 2021-03-29 2022-06-03 北京航空航天大学 一种基于动力学模型的双臂抓捕下空间目标参数辨识方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101726296B (zh) * 2009-12-22 2013-10-09 哈尔滨工业大学 空间机器人视觉测量、路径规划、gnc一体化仿真***
CN106426174B (zh) * 2016-11-05 2019-01-11 上海大学 一种基于力矩观测和摩擦辨识的机器人接触力检测方法

Also Published As

Publication number Publication date
CN109093620A (zh) 2018-12-28

Similar Documents

Publication Publication Date Title
CN109093620B (zh) 一种双目相机辅助的空间非合作目标动力学参数辨识方法
CN108375382B (zh) 基于单目视觉的位置姿态测量***精度检校方法和装置
CN107421534B (zh) 一种冗余式捷联惯导***多故障隔离方法
CN106289246B (zh) 一种基于位置和姿态测量***的柔性杆臂测量方法
Du et al. Online serial manipulator calibration based on multisensory process via extended Kalman and particle filters
JP4876204B2 (ja) 小型姿勢センサ
CN110296691A (zh) 融合imu标定的双目立体视觉测量方法与***
CN106056664A (zh) 一种基于惯性和深度视觉的实时三维场景重构***及方法
CN108106637B (zh) 一种分布式pos的精度检校方法和装置
CN105953795B (zh) 一种用于航天器表面巡视的导航装置及方法
CN107728182A (zh) 基于相机辅助的柔性多基线测量方法和装置
CN111590564A (zh) 一种六维力传感器重力补偿方法及***
CN110352331A (zh) 手持云台的姿态解算的方法和云台***
CN113267794B (zh) 一种基线长度约束的天线相位中心校正方法及装置
CN108375383A (zh) 多相机辅助的机载分布式pos柔性基线测量方法和装置
CN110849331A (zh) 基于三维点云数据库模型的单目视觉测量与地面试验方法
Chang-Siu et al. Time-varying complementary filtering for attitude estimation
CN111504314B (zh) Imu与刚体的位姿融合方法、装置、设备及存储介质
CN108444468B (zh) 一种融合下视视觉与惯导信息的定向罗盘
Liu et al. A high-accuracy pose measurement system for robotic automated assembly in large-scale space
CN107167145B (zh) 一种自适应非接触式失效卫星的形态参数测算方法
CN113870366A (zh) 基于位姿传感器的三维扫描***的标定方法及其标定***
CN113513999B (zh) 一种航天器结构静力试验大视场实时变形测量***及方法
CN108225371A (zh) 一种惯导/相机安装误差标定方法
CN109342008B (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