CN111098299B - 一种空间机器人扰动补偿的方法 - Google Patents
一种空间机器人扰动补偿的方法 Download PDFInfo
- Publication number
- CN111098299B CN111098299B CN201911241734.8A CN201911241734A CN111098299B CN 111098299 B CN111098299 B CN 111098299B CN 201911241734 A CN201911241734 A CN 201911241734A CN 111098299 B CN111098299 B CN 111098299B
- Authority
- CN
- China
- Prior art keywords
- platform
- moment
- formula
- rigid body
- disturbance
- 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 22
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000003068 static effect Effects 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 3
- 230000009471 action Effects 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开的一种空间机器人扰动补偿的方法,包括以下步骤:S1、基于凯恩动力学建立空间机器人整体动力学模型;S2、根据空间机器人整体动力学模型建立平台的刚体动力学模型,并计算机械臂对平台姿态的扰动力矩;S3、从角动量层面计算平台姿态控制的前馈补偿量,实现对平台姿态扰动力矩的补偿。本发明基于凯恩动力学原理分别建立空间机器人整体动力学模型以及空间机器人平台的动力学模型,从而快速准确的计算得出机械臂对平台姿态的扰动力矩,有效的补偿了平台姿态扰动力矩,具有计算量少,计算结果准确的特点,同时,为星上控制提供了一种新的思路。
Description
技术领域
本发明涉及空间机器人领域,尤其涉及基于凯恩动力学原理的空间漂浮机器人抓捕过程中扰动的补偿方法。
背景技术
空间漂浮机器人包含平台和机械臂,国内外对机械臂建模做了大量研究,采用多种方法如拉格朗日、牛顿-欧拉、凯恩等,考虑了多种因素,但对于实际应用来说,大多将机械臂作为扰动,对平台进行抗扰动控制,且并没有对空间漂浮机器人进行一体化建模进行扰动补偿。而且,国际上对空间漂浮机器人进行干扰力矩补偿的方法是基于牛顿欧拉原理建立空间漂浮机器人动力学模型并进行干扰力/力矩计算,采用反馈方式进行干扰力矩补偿控制,计算次数较多,仿真效率很低,对控制器的资源消耗较大。
发明内容
本发明提供一种空间机器人扰动补偿的方法,基于凯恩动力学原理对空间机器人进行一体化的建模,计算得出空间机器人机械臂对平台姿态的扰动力矩,并利用一体化动力学模型计算角动量对平台姿态的扰动力矩进行前馈补偿,本发明提供的方法采用较少的计算量即可计算得出平台姿态的扰动力矩,有效的实现了对平台姿态扰动力矩的补偿。
为了实现上述目的,本发明一种空间机器人扰动补偿的方法,包含以下步骤:
S1、基于凯恩动力学建立空间机器人整体动力学模型;
S2、根据空间机器人整体动力学模型建立平台的刚体动力学模型,并计算机械臂对平台姿态的扰动力矩;
S3、从角动量层面计算平台姿态控制的前馈补偿量,实现对平台姿态扰动力矩的补偿。
优选地,所述的空间机器人的整体动力学模型为:
式中,
式中,mj是单刚体Bj的质量,I为质量单位阵,Sj、Jj为单刚体Bj坐标系原点Oj的静矩、惯量,和分别表示单刚体Bj的加速度与角加速度,ωj表示刚体Bj的角速度,表示控制输入量的一阶导数,pVj表示单刚体Bj偏速度,pωj表示单刚体Bj偏角速度,表示单刚体Bj坐标系原点Oj的静矩的叉乘形式,表示刚体Bj的角速度叉乘形式,fb和τb分别为平台主动力和主动力矩;
式(11)等号右边的前6行为平台的主动力矩,式(11)等号右边从第7行开始是机器臂对平台姿态的扰动力矩。
优选地,所述的平台的刚体动力学模型为:
式中,分别表示平台速度和角速度在平台刚体坐标系投影的变化率,mb表示平台质量,Sb表示平台坐标系原点Ob的静矩,表示平台坐标系原点Ob的静矩的叉乘形式,Jb表示平台坐标系原点Ob的惯量,表示刚体在平台刚体坐标系投影的叉乘形式,Vb表示平台速度在平台刚体坐标系投影,frf和τrf分别为空间机器人平台的主动力与扰动力的差、空间机器人平台的主动力矩与扰动力矩的差;式(12)等号的右边包含了平台的主动力矩和机械臂对平台姿态的扰动力矩;
取式(11)的“前6行”:
式(12)减去式(13)得出机械臂对平台姿态的扰动力矩:
优选地,空间机器人平台姿态控制的角动量前馈补偿量为:
式中,Ik为第k部机械臂转动惯量,φk为第k部机械臂关节角组成的列阵,Kff为比例系数,取值范围是0<Kff<1;
在平台姿态控制***的控制回路中增加机械臂角动量补偿回路,实现机械臂对平台姿态扰动力矩的补偿,机械臂角动量补偿回路为:
式中,hd为指令角动量,Km为对称正定矩阵。
本发明具有以下优势:
本发明公开的一种空间机器人扰动补偿的方法,基于凯恩动力学原理分别建立空间机器人整体动力学模型以及空间机器人平台的动力学模型,从而快速准确的计算得出机械臂对平台姿态的扰动力矩,并从角动量层面建立前馈补充控制,有效实现对平台姿态扰动力矩的前馈补偿。本发明具有计算量少,计算结果准确的特点,同时,为星上控制提供了一种新的思路。
附图说明
附图1为本发明提供的空间机器人的结构图;
附图2为本发明实施例提供的一种空间机器人扰动力矩补偿方法的流程图。
具体实施方式
以下结合附图和具体实施例对本发明提出的一种空间机器人扰动补偿的方法作进一步详细说明。根据下面说明和权利要求书,本发明的优点和特征将更清楚。需说明的是,附图均采用非常简化的形式且均使用非精准的比率,仅用以方便、明晰地辅助说明本发明实施例的目的。
如图1所示,空间机器人包括平台和多个机械臂,机械臂运动过程中会对平台的姿态造成扰动,产生扰动力矩。
如图2所示,本发明公开的一种空间机器人扰动补偿的方法包含以下步骤:
S1、基于凯恩动力学建立空间机器人整体动力学模型;
将空间机器人的各个杆件等效为各个单刚体,基于凯恩动力原理,单刚体动力学模型为:
式中,mj是单刚体Bj的质量,I为质量单位阵,Sj、Jj为单刚体Bj坐标系原点Oj的静矩、惯量,物理量上面的符号“~”表示该物理量与后面的物理量进行叉乘运算,和分别表示单刚体Bj的加速度与角加速度,ωj表示刚体Bj的角速度,fj为作用于Bj的力系的主矢,τj为作用于Bj的力系对Oj的主矩,fj,τj包含所有作用于Bj的力的效应。
其中,vj表示刚体Bj的速度。
对空间机器人的所有单刚体的动力学模型求和,可得:
令
则,式(3)为:
令
则
将式(6)代入式(4)中,则式(4)等号右边为:
式(7)的第二项为平台与机械臂末端的接触力(平台的外界施加力);
式(7)的第一项为空间机器人关节中的主动和/或约束力,空间机器人关节是指空间机器人两个杆件之间可发生相对运动的部分,式(7)的第一项按关节展开为:
由于
则,式(7)的第一项简化为:
机械臂关节上作用的广义主动力矩为Tjthj,其中,Tj为偏速度,thj为关节主动力矩,则:
thj简化为tj,j=1,...,N,则机械臂的主动力为
定义一个虚拟关节,该虚拟关节表示空间机器人的平台与惯性系之间存在六自由度,即三个方向的位移和绕三个方向的旋转,虚拟关节中无力作用,即空间机器人除平台外不受力,则:
pvb=[I 0…0]
pωb=[0 I 0…0]
所以,引入虚拟关节的***主动力为
将空间机器人的关节(式(8))和虚拟关节(式(9))作用相结合,可得:
结合式(5)和式(10)可知,基于凯恩动力学建立空间机械人整体动力学模型:
由于空间机器人扰动力和扰动力矩一共是6维,因此,式(11)等号右边的前6行为平台的主动力矩,式(11)等号右边从第7行开始是机器臂对平台姿态的扰动力矩。
S2、根据空间机器人整体动力学模型建立平台的刚体动力学模型,并计算机械臂对平台姿态的扰动力矩;
式(11)的“前6行”可写为:
式(12)减去式(13)得出机械臂对平台姿态的扰动力矩:
S3、从角动量层面计算平台姿态控制的前馈补偿量,实现对平台姿态扰动力矩的补偿。
为了补偿机械臂的运动对平台姿态造成的扰动,通过角动量层面的协调关系建立前馈补偿控制。
当空间机器人初始角动量为零,且无外力矩作用时,空间机器人的角动量始终为零:
式中,L0为空间机器人对平台质心的角动量,I0为平台转动惯量,ω0为平台角速度,Ik为第k部机械臂转动惯量,φk为第k部机械臂关节角组成的列阵。
空间机器人角动量的变化量与平台控制力矩τ0及扰动力矩τd的关系为:
为了导出平台扰动力矩需补偿的角动量,假设平台在机械臂运动的过程中保持姿态不变,且初始角动量为零,则有:
式(17)给出了平台姿态控制角动量前馈补偿的补偿量。由于实际中平台姿态并不能完全保持不动,在补偿时不能完全按照式(17)进行,而应适当减小,故最终的前馈补偿量为:
式中,Kff为比例系数,取值范围是0<Kff<1。
为了使空间机器人中平台姿态控制***能够接受角动量指令,在平台姿态控制***的控制回路中增加机械臂角动量补偿回路,实现机械臂对平台姿态扰动力矩的补偿,机械臂角动量补偿回路为:
式中,hd为指令角动量,Km为对称正定矩阵。
常规的计算空间机器人平台扰动力矩的方法为:基于牛顿欧拉方法建立空间机器人的动力学模型,并根据牛顿欧拉动力学模型计算干扰力矩。本发明提供的空间机器人平台姿态干扰力矩的计算方法与常规方法相比,计算结果相同,而计算量不同,本发明提供的方法采用了6次加法和8次乘法,而常规的计算方法采用了27次加法和27次乘法,因此,本发明提供的机器人平台姿态的扰动力矩的计算方法具有计算量少的特点。
本发明公开的一种空间机器人扰动补偿的方法,基于凯恩动力学原理建立空间机器人整体动力学模型,机械臂和平台采用同一个动力学模型来描述,从而快速准确的计算得出机械臂对平台姿态的扰动力矩,并从角动量层面建立前馈补充控制,有效实现对平台姿态扰动力矩的前馈补偿。本发明具有计算量少,计算结果准确的特点,同时,为星上控制提供了一种新的思路。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (3)
1.一种空间机器人扰动补偿的方法,其特征在于,包含以下步骤:
S1、基于凯恩动力学建立空间机器人整体动力学模型;
S2、根据空间机器人整体动力学模型建立平台的刚体动力学模型,并计算机械臂对平台姿态的扰动力矩;
S3、从角动量层面计算平台姿态控制的前馈补偿量,实现对平台姿态扰动力矩的补偿;
平台姿态控制的前馈补偿量的计算公式为:
式中,Ik为第k部机械臂转动惯量,φk为第k部机械臂关节角组成的列阵,Kff为比例系数,t为时间,取值范围是0<Kff<1;
在平台姿态控制***的控制回路中增加机械臂角动量补偿回路,实现机械臂对平台姿态扰动力矩的补偿,机械臂角动量补偿回路为:
式中,hd为指令角动量,Km为对称正定矩阵。
3.如权利要求2所述的一种空间机器人扰动补偿的方法,其特征在于,所述的平台的刚体动力学模型为:
式中,分别表示平台速度和角速度在平台刚体坐标系投影的变化率,mb表示平台质量,Sb表示平台坐标系原点Ob的静矩,表示平台坐标系原点Ob的静矩的叉乘形式,Jb表示平台坐标系原点Ob的惯量,表示刚体在平台刚体坐标系投影的叉乘形式,Vb表示平台速度在平台刚体坐标系投影,frf和τrf分别为空间机器人平台的主动力与扰动力的差、空间机器人平台的主动力矩与扰动力矩的差;
式(12)等号的右边包含了空间机器人平台的主动力矩和机械臂对平台姿态的扰动力矩;
取式(11)的“前6行”:
式(12)减去式(13)得出机械臂对平台姿态的扰动力矩:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911241734.8A CN111098299B (zh) | 2019-12-06 | 2019-12-06 | 一种空间机器人扰动补偿的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911241734.8A CN111098299B (zh) | 2019-12-06 | 2019-12-06 | 一种空间机器人扰动补偿的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111098299A CN111098299A (zh) | 2020-05-05 |
CN111098299B true CN111098299B (zh) | 2021-09-07 |
Family
ID=70422477
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911241734.8A Active CN111098299B (zh) | 2019-12-06 | 2019-12-06 | 一种空间机器人扰动补偿的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111098299B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114800496B (zh) * | 2022-04-18 | 2023-11-03 | 中国科学院空间应用工程与技术中心 | 空间机器人接触操作的风险判定方法、***、介质及设备 |
CN115128960B (zh) * | 2022-08-30 | 2022-12-16 | 齐鲁工业大学 | 一种基于深度强化学习双足机器人运动控制方法及*** |
CN115556111B (zh) * | 2022-10-26 | 2023-08-18 | 哈尔滨工业大学 | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 |
CN117001675B (zh) * | 2023-09-28 | 2024-05-31 | 江苏云幕智造科技有限公司 | 一种双臂协作操控非合作目标避障轨迹规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05178295A (ja) * | 1991-12-11 | 1993-07-20 | Ishikawajima Harima Heavy Ind Co Ltd | 宇宙ロボット及びその協調制御方法 |
JPH06198585A (ja) * | 1993-01-05 | 1994-07-19 | Ishikawajima Harima Heavy Ind Co Ltd | 宇宙ロボットの姿勢制御方法及びその装置 |
CN101726296A (zh) * | 2009-12-22 | 2010-06-09 | 哈尔滨工业大学 | 空间机器人视觉测量、路径规划、gnc一体化仿真*** |
CN107703753A (zh) * | 2017-10-25 | 2018-02-16 | 南京邮电大学 | 一种空间机械臂的容错控制方法 |
CN107967241A (zh) * | 2017-11-21 | 2018-04-27 | 中国运载火箭技术研究院 | 一种空间自由漂浮机器人的基座扰动计算方法 |
CN110532581A (zh) * | 2019-05-14 | 2019-12-03 | 武汉弗雷德斯科技发展有限公司 | 一种四轴机械臂的动力学建模方法 |
-
2019
- 2019-12-06 CN CN201911241734.8A patent/CN111098299B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05178295A (ja) * | 1991-12-11 | 1993-07-20 | Ishikawajima Harima Heavy Ind Co Ltd | 宇宙ロボット及びその協調制御方法 |
JPH06198585A (ja) * | 1993-01-05 | 1994-07-19 | Ishikawajima Harima Heavy Ind Co Ltd | 宇宙ロボットの姿勢制御方法及びその装置 |
CN101726296A (zh) * | 2009-12-22 | 2010-06-09 | 哈尔滨工业大学 | 空间机器人视觉测量、路径规划、gnc一体化仿真*** |
CN107703753A (zh) * | 2017-10-25 | 2018-02-16 | 南京邮电大学 | 一种空间机械臂的容错控制方法 |
CN107967241A (zh) * | 2017-11-21 | 2018-04-27 | 中国运载火箭技术研究院 | 一种空间自由漂浮机器人的基座扰动计算方法 |
CN110532581A (zh) * | 2019-05-14 | 2019-12-03 | 武汉弗雷德斯科技发展有限公司 | 一种四轴机械臂的动力学建模方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111098299A (zh) | 2020-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111098299B (zh) | 一种空间机器人扰动补偿的方法 | |
WO2022252863A1 (zh) | 轮腿式机器人的控制方法、装置、轮腿式机器人及设备 | |
CN111558941B (zh) | 浮动基动力学前馈控制方法、装置和多足机器人 | |
Huang et al. | Adaptive control for space debris removal with uncertain kinematics, dynamics and states | |
Sharifi et al. | Nonlinear model reference adaptive impedance control for human–robot interactions | |
Yamane et al. | Simultaneous tracking and balancing of humanoid robots for imitating human motion capture data | |
CN104589349B (zh) | 一种混合悬浮微重力环境下带有单关节机械臂的组合体自主控制方法 | |
Lee et al. | Adaptive sliding mode control for spacecraft body-fixed hovering in the proximity of an asteroid | |
Metni et al. | Visual tracking control of aerial robotic systems with adaptive depth estimation | |
Meng et al. | Space robots with flexible appendages: dynamic modeling, coupling measurement, and vibration suppression | |
CN106985139A (zh) | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 | |
CN105772917B (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
Meng et al. | Vibration suppression control of free-floating space robots with flexible appendages for autonomous target capturing | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂*** | |
Li et al. | Visual servoing of flexible-link manipulators by considering vibration suppression without deformation measurements | |
CN113119100A (zh) | 冗余机械臂控制方法、装置、可读存储介质及设备 | |
Park et al. | Pose and posture estimation of aerial skeleton systems for outdoor flying | |
Asl | Robust vision-based tracking control of VTOL unmanned aerial vehicles | |
CN115556111B (zh) | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 | |
Hu et al. | Recursive decentralized control for robotic manipulators | |
CN115122325A (zh) | 一种具有视场约束的拟人化机械手鲁棒视觉伺服控制方法 | |
Zhao et al. | Flight motion of passing through small opening by dragon: Transformable multilinked aerial robot | |
CN115480583A (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
Shi et al. | Modeling and simulation of space robot visual servoing for autonomous target capturing | |
Salamat et al. | A swash mass pendulum with passivity-based control |
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 |