CN105904458B - 一种基于复杂操作任务的非完整遥操作约束控制方法 - Google Patents
一种基于复杂操作任务的非完整遥操作约束控制方法 Download PDFInfo
- Publication number
- CN105904458B CN105904458B CN201610323695.6A CN201610323695A CN105904458B CN 105904458 B CN105904458 B CN 105904458B CN 201610323695 A CN201610323695 A CN 201610323695A CN 105904458 B CN105904458 B CN 105904458B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- constraint
- mechanical arm
- mtr
- 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 28
- 230000033001 locomotion Effects 0.000 claims abstract description 62
- 239000011159 matrix material Substances 0.000 claims abstract description 44
- 238000013519 translation Methods 0.000 claims abstract description 11
- 230000000452 restraining effect Effects 0.000 claims description 8
- 230000026058 directional locomotion Effects 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 238000013459 approach Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 238000013461 design Methods 0.000 abstract description 2
- 230000006978 adaptation Effects 0.000 abstract 1
- 230000000694 effects Effects 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012913 prioritisation Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000012360 testing 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于复杂操作任务的非完整遥操作约束控制方法，通过计算约束矩阵CVF，复杂操作任务分解，最终设计约束控制器；本发明针对复杂的空间操控任务，与一般的机械臂控制方法相比较，具有任务层面和控制方法的两大有益效果。首先，机械臂在空间中要完成的操控任务包括目标接近、路径跟踪及躲避障碍等，本发明根据操作任务的不同选取合适的运动旋量集合来构造约束矩阵，较以往方法更具有适应复杂任务的能力；其次，非完整约束控制方法可以使操作更加灵活，操作者可以控制机械臂仅在平移或旋转方向运动，无需提供额外的约束，从而减轻操作者压力。
Description
【技术领域】
本发明属于空间遥操作技术领域，涉及一种基于复杂操作任务的非完整遥操作约束控制方法。
【背景技术】
在诸多机器人领域中已经证明了虚拟夹具在任务执行时间及总体精准度方面都有提高，然而夹具也是非灵敏型的辅助，如在空间遥操作过程中，需要通过虚拟夹具对机械臂末端的位置及姿态同时进行控制，在保证位置控制最优的情况下往往会失去对末端姿态的准确控制。为了在空间遥操作中实现良好的操作效果，需要给机械臂末端添加合适的辅助，使其灵活的根据任务环境及操作任务进行位置和姿态协调。
在非结构化环境中，机器人的运动受到几何及动力学约束，平移和旋转自由度受到限制。在空间遥操作任务过程时，机械臂末端一般只在平动方向约束情况下便能完成操作任务，然而针对一些复杂的空间操控任务，仅仅平动方向的约束限制难以保证操作的高效性和安全性，故要求在机械臂末端旋转方向也添加辅助作用，使操作者能够动态的根据实际操作环境改变平动和旋转方向的虚拟夹具辅助效果，从而更好的完成遥操作任务。
【发明内容】
本发明的目的在于克服上述现有技术的缺点，提供一种基于复杂操作任务的非完整遥操作约束控制方法。
为达到上述目的，本发明采用以下技术方案予以实现：
一种基于复杂操作任务的非完整遥操作约束控制方法，包括以下步骤：
1)计算约束矩阵CVF；
定义约束矩阵CVF表示对应的约束能力，且CVF是6×6半正定对称矩阵，并将空间作用力映射成CVF的矩阵元素；操作者控制机械臂末端向着最优方向和非最优方向的运动构成了空间几何约束，且都由se(3)中的单位旋量表示，给出旋量集合S：则分解成m个rank-1的半正定矩阵之和：
其中，正比例系数ci代表了每个约束矩阵Ci的约束能力大小，强约束使操作者控制机械臂末端沿着最优方向运动，弱约束使沿着非最优方向发生偏离；
操作者控制力的大小决定了机械臂末端在旋转和平移方向发生的位移变化δXb＝(δφb,δqb)，有
其中，表示作用在机械臂末端的操作者控制力，δXb表示旋转和平移方向的微小位移；虚拟夹具辅助下的完整约束等同于约束矩阵C为满秩矩阵，而非完整约束则对应约束矩阵C为非满秩矩阵；
2)复杂操作任务分解；
遥操作中的复杂操作任务能够分解成多个任务的组合；针对几个不同的任务，选取最优的运动旋量集合；
3)约束控制器设计；
设机械臂的空间运动速度为Vb＝(ωb,vb)，其中ωb、vb分别表示惯性空间中机械臂的旋转角速度和切向速度；控制器设计如下：
其中，约束矩阵CVF(g,gd)表示对机械臂的约束能力，操作者控制力定义为Fb＝(mb,fb)，比例系数Kc＝diag(crI3×3,cpI3×3)控制操作者约束作用力的大小。
2.根据权利要求1所述的基于复杂操作任务的非完整遥操作约束控制方法，其特征在于，所述步骤2)中，选取最优的运动旋量集合的具体方法如下：
2-1)目标接近
设机械臂在位形空间中的参考轨迹为gd，其当前位形为g，则距离参考轨迹的误差表示为
对应的运动旋量集合取误差的对数表达，有
对应的约束矩阵CVF＝cS由运动旋量集合构成，c的大小决定了约束作用力的强弱；
2-2)轨迹跟踪
设机械臂运动的参考轨迹为gr(λ,t)，机械臂运动的轴线为r为运动轴线上任意一点，λ为平动方向的进动参数，||s||＝1，则相对应的切向速度为
记切向速度为单位旋量集合S1，S2为误差的对数形式:
则约束矩阵为
CVF＝c1S1+c2S2 (7)
其中，正比例系数c1的大小决定了机械臂受虚拟夹具约束的运动速度大小，且c1越大对应的运动速度会减小，c2的大小决定了机械臂跟踪参考轨迹的能力；
2-3)平面运动
假设机械臂末端的运动速度向量为v1和v2，则span{v1,v2}是指以v1，v2为基生成的平面，操作者控制机械臂在该二维平面内运动，定义运动旋量ξ＝(ω,v)，当沿着v1方向运动时，取ω＝s＝0，则v1方向的运动旋量集合为S1＝(0,v1)，同理v2方向的运动旋量集合为S2＝(0,v2)，则机械臂在约束作用下沿轴向s运动的旋量集合为S3＝(s,r×s)，r为s上任意一点；
从而，约束矩阵定义为
CVF＝c1S1+c2S2+c3S3 (8)
其中，c1的大小决定机械臂沿v1方向运动的能力，c2的大小决定机械臂沿v2方向运动的能力，c3的大小决定机械臂在约束轴向s运动的能力，其中包括绕轴向转动的约束作用。
与现有技术相比，本发明具有以下有益效果：
本发明针对复杂的空间操控任务，与一般的机械臂控制方法相比较，具有任务层面和控制方法的两大有益效果。首先，机械臂在空间中要完成的操控任务包括目标接近、路径跟踪及躲避障碍等，本发明根据操作任务的不同选取合适的运动旋量集合来构造约束矩阵，较以往方法更具有适应复杂任务的能力；其次，非完整约束控制方法可以使操作更加灵活，操作者可以控制机械臂仅在平移或旋转方向运动，无需提供额外的约束，从而减轻操作者压力。
【附图说明】
图1约束功率原理图。
图2平面约束运动示意图。
图3球面及其切平面示意图。
图4球面截面操作示意图。
【具体实施方式】
下面结合附图对本发明做进一步详细描述：
参见图1-4，基于复杂操作任务的非完整遥操作约束控制方法，其特征在于，包括以下步骤：
步骤一：计算约束矩阵CVF。
操作者控制机械臂在空间环境中完成复杂任务，要求对机械臂末端控制力进行有效约束作用，这样的一种约束作用构成虚拟夹具，定义约束矩阵CVF表示对应的约束能力，且CVF是6×6半正定对称矩阵，并将空间作用力映射成CVF的矩阵元素。操作者控制机械臂末端向着最优方向和非最优方向的运动构成了空间几何约束，且都可以由se(3)中的单位旋量表示，给出旋量集合S：则可以分解成m个rank-1的半正定矩阵之和：
其中，正比例系数ci代表了每个约束矩阵Ci的约束能力大小，强约束使操作者控制机械臂末端沿着最优方向运动，弱约束使沿着非最优方向发生偏离。这样的运动优先级区分降低了操作者的操作压力，即操作者只需控制机械臂在虚拟夹具约束作用范围内运动。
操作者控制力的大小决定了机械臂末端在旋转和平移方向发生的位移变化δXb＝(δφb,δqb)，有
其中，表示作用在机械臂末端的操作者控制力，δXb表示旋转和平移方向的微小位移。虚拟夹具辅助下的完整约束等同于约束矩阵C为满秩矩阵，而非完整约束则对应约束矩阵C为非满秩矩阵。
步骤二：复杂操作任务分解。
基于上述理论知识，遥操作中的复杂操作任务可以分解成多个简单任务(如目标接近、路径跟踪、躲避障碍等)的组合。针对几个不同的简单任务，选取最优的运动旋量集合：
(1)目标接近
设机械臂在位形空间中的参考轨迹为gd，其当前位形为g，则距离参考轨迹的误差表示为
对应的运动旋量集合取误差的对数表达，有
对应的约束矩阵CVF＝cS由运动旋量集合构成，c的大小决定了约束作用力的强弱，操作者只需按照虚拟夹具提供的约束作用力随动完成操作任务即可，不需要提供额外的控制力。
(2)轨迹跟踪
设机械臂运动的参考轨迹为gr(λ,t)，机械臂运动的轴线为r为运动轴线上任意一点，λ为平动方向的进动参数，||s||＝1，则相对应的切向速度为
记切向速度为单位旋量集合S1，S2同4.3.1节中一样，定义为误差的对数形式
则约束矩阵为
CVF＝c1S1+c2S2 (7)
其中，正比例系数c1的大小决定了机械臂受虚拟夹具约束的运动速度大小，且c1越大对应的运动速度会减小，c2的大小决定了机械臂跟踪参考轨迹的能力。
(3)平面运动
假设机械臂末端的运动速度向量为v1和v2，则span{v1,v2}是指以v1，v2为基生成的平面，操作者控制机械臂在该二维平面内运动，如图2所示，定义运动旋量ξ＝(ω,v)，当沿着v1方向运动时，取ω＝s＝0，则v1方向的运动旋量集合为S1＝(0,v1)，同理v2方向的运动旋量集合为S2＝(0,v2)，则机械臂在约束作用下沿轴向s运动的旋量集合为S3＝(s,r×s)，r为s上任意一点。
从而，约束矩阵可定义为
CVF＝c1S1+c2S2+c3S3 (8)
其中，c1的大小决定机械臂沿v1方向运动的能力，c2的大小决定机械臂沿v2方向运动的能力，c3的大小决定机械臂在约束轴向s运动的能力，其中包括绕轴向转动的约束作用。
步骤三：约束控制器设计。
操作者控制机械臂完成给定任务时，需要机械臂在旋转和平移方向都保持在稳定的速度阈值内，基于此，设机械臂的空间运动速度为Vb＝(ωb,vb)，其中ωb、vb分别表示惯性空间中机械臂的旋转角速度和切向速度。控制器设计如下：
其中，约束矩阵CVF(g,gd)表示对机械臂的约束能力，操作者控制力定义为Fb＝(mb,fb)，比例系数Kc＝diag(crI3×3,cpI3×3)控制操作者约束作用力的大小，由于强约束使机械臂沿着最优方向运动速度较快，为防止速度过快导致碰撞等意外情况的发生，选取合适的cr、cp使操作者约束力施加的大小得以控制，防止机械臂因失去控制而导致任务的失败。
本发明的原理：
经典分析力学中，约束可分为完整约束和非完整约束。空间遥操作中机械臂在操作者控制下能否实现给定的运动，与约束控制力的完整性和简化操作任务等有关。在非完整约束情况下，即对机械臂进行部分约束限制，具体表现为参考轨迹的操作自由度小于机械臂位形空间的维数，如在二维曲面上控制机械臂末端从A点运动至B点，给定任务序列Tr([mx,my,mz],pr)，其中(mx,my,mz)指的是任务序列上的任一点坐标，pr表示约束功率，如图1所示，对于被约束对象是否能实现给定的运动，其判别方法通常是考察约束力旋量与给定速度旋量的乘积即瞬时约束功率(简称约束功率)是否为零，若约束功率为零则该运动为约束允许的运动。
为了验证所设计控制器在变化操作环境中的对机械臂的有效约束作用，设计动态轨迹跟踪实验如下：
(1)实验中，操作者控制末端操作工具沿参考轨迹运动，并设计控制末端所在的操作环境是动态变化的。在动态轨迹跟踪实验中，首先设置实验环境(动态变化球面)的动态变化频率为ω(0～45rad/s)，设参考轨迹为球面上r＝50mm的纬线圆(球体半径为r0＝100mm)，如图3所示，
(2)机械臂末端在由起始点向着目标点运动时，运动旋量集合由两部分组成，记切向速度为单位旋量集合S1，S2定义为误差的对数形式则约束矩阵为
CVF＝c1S1+c2S2
其中，令c1＝0.6，c2＝0.8，正比例系数c1的大小决定了机械臂受虚拟夹具约束下的运动速度大小，c2的大小决定了机械臂跟踪参考轨迹的能力。
(3)在二维曲面中，使约束功率pr＝0的操作状态是控制机械臂末端沿某一轴向运动(如z轴)，而围绕z轴的所有转动对z方向的运动没有约束影响，则机械臂末端可沿着z轴做连续运动。
设定变化的球体半径为r＝r0+Δr sinωt，其中Δr＝20mm。比例系数Kc＝diag(crI3×3,cpI3×3)控制操作者约束作用力的大小，试验过程中，选取cr＝0.1rad/s,cp＝100mm/s，操作者控制末端操作工具从起始位置g0向着参考轨迹gd运动，如图4所示为球面直径方向截平面操作示意图：
实验结果表明，在变化环境中，操作者根据不同操作任务选取相应的运动旋量集合构造约束矩阵，从而可以很好的约束末端操作工具沿着指定的方向运动。
以上内容仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明权利要求书的保护范围之内。
Claims (2)
1.一种基于复杂操作任务的非完整遥操作约束控制方法，其特征在于，包括以下步骤：
1)计算约束矩阵CVF；
定义约束矩阵CVF表示对应的约束能力，且CVF是6×6半正定对称矩阵，并将空间作用力映射成CVF的矩阵元素；操作者控制机械臂末端向着最优方向和非最优方向的运动构成了空间几何约束，且都由se(3)中的单位旋量表示，给出旋量集合则分解成m个rank-1的半正定矩阵之和：
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>C</mi>
<mrow>
<mi>V</mi>
<mi>F</mi>
</mrow>
<mi>b</mi>
</msubsup>
<mo>=</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mi>S</mi>
<mn>1</mn>
</msub>
<msubsup>
<mi>S</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
<msub>
<mi>S</mi>
<mn>2</mn>
</msub>
<msubsup>
<mi>S</mi>
<mn>2</mn>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>c</mi>
<mi>m</mi>
</msub>
<msub>
<mi>S</mi>
<mi>m</mi>
</msub>
<msubsup>
<mi>S</mi>
<mi>m</mi>
<mi>T</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msub>
<mi>C</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mi>c</mi>
<mi>i</mi>
</msub>
<mo>></mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，正比例系数ci代表了每个约束矩阵Ci的约束能力大小，强约束使操作者控制机械臂末端沿着最优方向运动，弱约束使沿着非最优方向发生偏离；
操作者控制力的大小决定了机械臂末端在旋转和平移方向发生的位移变化δXb＝(δφb,δqb)，有
<mrow>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>&delta;&phi;</mi>
<mi>b</mi>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>&delta;q</mi>
<mi>b</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mrow>
<mi>V</mi>
<mi>F</mi>
</mrow>
<mi>b</mi>
</msubsup>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<msup>
<mi>m</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>f</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，表示作用在机械臂末端的操作者控制力，δXb表示旋转和平移方向的微小位移；虚拟夹具辅助下的完整约束等同于约束矩阵C为满秩矩阵，而非完整约束则对应约束矩阵C为非满秩矩阵；
2)复杂操作任务分解；
遥操作中的复杂操作任务能够分解成多个任务的组合；针对几个不同的任务，选取最优的运动旋量集合；
3)约束控制器设计；
设机械臂的空间运动速度为Vb＝(ωb,vb)，其中ωb、vb分别表示惯性空间中机械臂的旋转角速度和切向速度；控制器设计如下：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msup>
<mi>&omega;</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>v</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>c</mi>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>V</mi>
<mi>F</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>g</mi>
<mo>,</mo>
<msub>
<mi>g</mi>
<mi>d</mi>
</msub>
<mo>)</mo>
</mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msup>
<mi>m</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>f</mi>
<mi>b</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，约束矩阵CVF(g,gd)表示对机械臂的约束能力，操作者控制力定义为比例系数Kc＝diag(crI3×3,cpI3×3)控制操作者约束作用力的大小。
2.根据权利要求1所述的基于复杂操作任务的非完整遥操作约束控制方法，其特征在于，所述步骤2)中，选取最优的运动旋量集合的具体方法如下：
2-1)目标接近
设机械臂在位形空间中的参考轨迹为gd，其当前位形为g，则距离参考轨迹的误差表示为
<mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msubsup>
<mi>g</mi>
<mi>d</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>g</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
对应的运动旋量集合取误差的对数表达，有
<mrow>
<mi>S</mi>
<mo>=</mo>
<mi>l</mi>
<mi>o</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>g</mi>
<mi>d</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>g</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mover>
<mi>&psi;</mi>
<mo>^</mo>
</mover>
<mo>,</mo>
<mi>q</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
对应的约束矩阵CVF＝cS由运动旋量集合构成，c的大小决定了约束作用力的强弱；
2-2)轨迹跟踪
设机械臂运动的参考轨迹为gr(λ,t)，机械臂运动的轴线为r为运动轴线上任意一点，λ为平动方向的进动参数，||s||＝1，则相对应的切向速度为
<mrow>
<msub>
<mi>V</mi>
<mi>t</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>,</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<msub>
<mi>g</mi>
<mi>r</mi>
</msub>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>&lambda;</mi>
</mrow>
</mfrac>
<msubsup>
<mi>g</mi>
<mi>r</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
记切向速度为单位旋量集合S1，S2为误差的对数形式:
<mrow>
<msub>
<mi>S</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>l</mi>
<mi>o</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>g</mi>
<mi>r</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>g</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
则约束矩阵为
CVF＝c1S1+c2S2 (7)
其中，正比例系数c1的大小决定了机械臂受虚拟夹具约束的运动速度大小，且c1越大对应的运动速度会减小，c2的大小决定了机械臂跟踪参考轨迹的能力；
2-3)平面运动
假设机械臂末端的运动速度向量为v1和v2，则span{v1,v2}是指以v1，v2为基生成的平面，操作者控制机械臂在该二维平面内运动，定义运动旋量ξ＝(ω,v)，当沿着v1方向运动时，取ω＝s＝0，则v1方向的运动旋量集合为S1＝(0,v1)，同理v2方向的运动旋量集合为S2＝(0,v2)，则机械臂在约束作用下沿轴向s运动的旋量集合为S3＝(s,r×s)，r为s上任意一点；
从而，约束矩阵定义为
CVF＝c1S1+c2S2+c3S3 (8)
其中，c1的大小决定机械臂沿v1方向运动的能力，c2的大小决定机械臂沿v2方向运动的能力，c3的大小决定机械臂在约束轴向s运动的能力，其中包括绕轴向转动的约束作用。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610323695.6A CN105904458B (zh) | 2016-05-16 | 2016-05-16 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610323695.6A CN105904458B (zh) | 2016-05-16 | 2016-05-16 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105904458A CN105904458A (zh) | 2016-08-31 |
| CN105904458B true CN105904458B (zh) | 2018-01-19 |
Family
ID=56748472
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610323695.6A Active CN105904458B (zh) | 2016-05-16 | 2016-05-16 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105904458B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109746922A (zh) * | 2019-03-11 | 2019-05-14 | 河海大学常州校区 | 一种基于有限时间切换控制的非完整机器人控制方法 |
| CN110948488B (zh) * | 2019-11-26 | 2023-04-11 | 江苏集萃智能制造技术研究所有限公司 | 一种基于时间最优的机器人自适应轨迹规划算法 |
| CN114779793B (zh) * | 2022-06-21 | 2022-08-26 | 北京大学 | 一种基于动态向量场的轮式机器人运动规划方法 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102122172A (zh) * | 2010-12-31 | 2011-07-13 | 中国科学院计算技术研究所 | 机器运动控制的摄像***及其控制方法 |
| CN103144111A (zh) * | 2013-02-26 | 2013-06-12 | 中山大学 | 一种qp统一协调的移动机械臂运动描述与规划方法 |
| CN104407611A (zh) * | 2014-09-30 | 2015-03-11 | 同济大学 | 一种仿人机器人稳定行走的控制方法 |
| CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
| CN105183009A (zh) * | 2015-10-15 | 2015-12-23 | 哈尔滨工程大学 | 一种冗余机械臂轨迹控制方法 |
| CN105234930A (zh) * | 2015-10-15 | 2016-01-13 | 哈尔滨工程大学 | 基于构形平面的冗余机械臂运动控制方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0852675A (ja) * | 1994-08-16 | 1996-02-27 | Nippon Telegr & Teleph Corp <Ntt> | マニピュレータの選択的外乱補償型ハイブリッド制御装置および制御方法 |
-
2016
- 2016-05-16 CN CN201610323695.6A patent/CN105904458B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102122172A (zh) * | 2010-12-31 | 2011-07-13 | 中国科学院计算技术研究所 | 机器运动控制的摄像***及其控制方法 |
| CN103144111A (zh) * | 2013-02-26 | 2013-06-12 | 中山大学 | 一种qp统一协调的移动机械臂运动描述与规划方法 |
| CN104407611A (zh) * | 2014-09-30 | 2015-03-11 | 同济大学 | 一种仿人机器人稳定行走的控制方法 |
| CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
| CN105183009A (zh) * | 2015-10-15 | 2015-12-23 | 哈尔滨工程大学 | 一种冗余机械臂轨迹控制方法 |
| CN105234930A (zh) * | 2015-10-15 | 2016-01-13 | 哈尔滨工程大学 | 基于构形平面的冗余机械臂运动控制方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105904458A (zh) | 2016-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Wang et al. | Underwater bioinspired propulsion: From inspection to manipulation | |
| Jin et al. | Six-degree-of-freedom hovering control of an underwater robotic platform with four tilting thrusters via selective switching control | |
| Dong et al. | Robust adaptive control of nonholonomic mobile robot with parameter and nonparameter uncertainties | |
| CN105904458B (zh) | 一种基于复杂操作任务的非完整遥操作约束控制方法 | |
| Winkler et al. | Force controlled contour following on unknown objects with an industrial robot | |
| Osman et al. | End-effector stabilization of a 10-dof mobile manipulator using nonlinear model predictive control | |
| Mendoza-Soto et al. | Quadcopter path following control. a maneuvering approach | |
| Filaretov et al. | Development of control systems for implementation of manipulative operations in hovering mode of underwater vehicle | |
| Ginnante et al. | Kinetostatic optimization for kinematic redundancy planning of nimbl’bot robot | |
| Siradjuddin et al. | An Exponential Decreased Kinematic and PID Low Level Control Schemes for an Omni-Wheeled Mobile Robot | |
| Bulut et al. | Computed torque control of an aerial manipulation system with a quadrotor and a 2-dof robotic arm | |
| JP4133381B2 (ja) | 宇宙ロボットの姿勢制御方法及び装置 | |
| Takahashi et al. | Model predictive obstacle avoidance control for leg/wheel mobile robots with optimized articulated leg configuration | |
| Jin et al. | A motion planning method based vision servo for free-flying space robot capturing a tumbling satellite | |
| Worrall et al. | Autonomous planetary rover control using inverse simulation | |
| Hassani et al. | Mobile Robot Navigation Based on Turning Point Algorithm and Sliding Mode Controller | |
| Zhang et al. | Varying inertial parameters model based robust control for an aerial manipulator | |
| Bae et al. | Comparative study on underwater manipulation methods for valve-turning operation | |
| Vazquez et al. | Lyapunov Based Trajectory Tracking Dynamic Control for a QBOT-2 | |
| Ramakrishnan et al. | Adaptive control of nonholonomic wheeled mobile robot | |
| M'Hiri et al. | New Terminal Sliding Mode Control of the Parallel robot Par4 | |
| Anggraeni et al. | Formation tracking control simulation of multi robot systems for omni-wheels robot | |
| Katsurin | PLANNING TRAJECTORY OF THE MOBILE ROBOT WITH A CAMERA. | |
| Takada et al. | Receding horizon control on steering of control moment gyro for fast attitude maneuver | |
| Manel et al. | Predictive control based on dynamic modeling of omnidirectional mobile robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |