一种应用于大空间多连杆设备操控的绳驱控制方法技术

一种应用于大空间多连杆设备操控的绳驱控制方法，涉及一种绳驱机器人装配技术，为了解决现有的大型连杆设备的装配过程中，被装设备可移动范围狭小，可变姿态的范围十分有限的问题。本发明专利技术通过计算基座连杆的6个绳索牵引点的期望位置在世界坐标系中的坐标；依次计算后续连杆的绕绳点的期望位置在世界坐标系中的坐标；结合逆运动学结算出各根绳索所需运动的长度，同时转换成电机所需旋转的角度；通过控制电机协同运动进行释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。有益效果为空间范围移动大，多绳索协同控制，多连杆设备姿态可变。备姿态可变。备姿态可变。

【技术实现步骤摘要】
一种应用于大空间多连杆设备操控的绳驱控制方法


[0001]本专利技术涉及一种绳驱机器人装配技术。

技术介绍

[0002]随着生产经济发展，大空间多连杆设备的装配问题逐渐成为主要装配问题，例如多关节机械臂的装配任务，以及工厂大型连杆设备的组装任务；就这些任务而言主要是如何完成大空间同步移动以及连杆可变姿态的装配任务。
[0003]目前进行大型连杆设备的装配主要采用刚性支架或刚性连杆进行分段式安装，这种装配方法导致被装设备可移动范围狭小，可变姿态的范围十分有限。

技术实现思路

[0004]本专利技术的目的是为了解决现有的大型连杆设备的装配过程中，被装设备可移动范围狭小，可变姿态的范围十分有限的问题，提出了一种应用于大空间多连杆设备操控的绳驱控制方法。
[0005]本专利技术所述的一种应用于大空间多连杆设备操控的绳驱控制方法，该绳驱控制方法是基于多连杆设备操控的绳驱控制装置实现的；该绳驱控制方法是用于对多连杆设备进行操控；所述多连杆设备包括一个基座连杆与多个后续连杆；
[0006]所述基座连杆与其相邻的一个后续连杆通过铰链进行连接；并且，多个后续连杆之间依次通过铰链进行连接；
[0007]所述基座连杆采用6根绳索牵引，多个后续连杆均采用1根绳索牵引，通过电机对多绳索协同控制最终实现将多连杆设备调整到期望位置；
[0008]该绳驱控制方法具体包括以下步骤：
[0009]步骤一、计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标；
[0010]步骤二、根据步骤一计算得到的基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的基座连杆6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度；
[0011]步骤三、依次计算后续连杆绳索牵引点的期望位置在世界坐标系中的坐标；
[0012]步骤四、根据步骤二计算得到的后续连杆的绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的后续连杆绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度；
[0013]步骤五、将步骤二得出的6根绳索各自所需的运动长度以及步骤四得出的各绳索所需的运动长度，分别转换成电机所需旋转的角度；
[0014]步骤六、以步骤五得出的电机所需旋转的角度为基准，通过控制电机协同运动进行分别释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。
[0015]本专利技术的有益效果是：在大空间范围移动，多绳索协同控制，多连杆设备姿态可变三个主要方面；
[0016]1大空间范围移动：通过绳索的柔性以及轻质量特性，实现超大空间的绳索部署，从而实现超大范围的移动。
[0017]2多绳索协同控制：采用多绳索集群协同控制，可以实现更为复杂的运动，可以完成自由度更多的物体移动任务，稳定性更高。
[0018]3多连杆设备姿态可变：可以实现多连杆设备位置以及姿态的多自由度变化，完成更加复杂，更加灵活的装配任务需求。
附图说明
[0019]图1为具体实施方式一所述的一种应用于大空间多连杆设备操控的绳驱控制装置结构示意图；其中，基座连杆的长为l1，宽为w1，高为h1，O1‑
X1Y1Z1为以基座连杆中心所建立的坐标系，P
11
，P
12
，P
13
，P
14
，P
15
，P
16
为基座连杆的绳索牵引点，C
11
，C
12
，C
13
，C
14
，C
15
，C
16
为绳驱系统连接基座连杆的出绳点；
[0020]图2为具体实施方式一所述的一种应用于大空间多连杆设备操控的绳驱控制方法流程图；
[0021]图3为具体实施方式一中对基座连杆期望位置调整的具体流程图。
具体实施方式
[0022]具体实施方式一：结合图1至图3说明本实施方式，本实施方式所述的一种应用于大空间多连杆设备操控的绳驱控制方法，该绳驱控制方法是用于对多连杆设备进行操控；所述多连杆设备包括一个基座连杆1与多个后续连杆2；
[0023]所述基座连杆1与其相邻的一个后续连杆2通过铰链进行连接；并且，多个后续连杆2之间依次通过铰链进行连接；
[0024]所述基座连杆1采用6根绳索牵引，多个后续连杆2均采用1根绳索牵引，通过电机对多绳索协同控制最终实现将多连杆设备调整到期望位置；基座连杆1或后续连杆2与牵引绳索的连接点为牵引点；考虑多连杆设备是由一个基座连杆1与多个后续连杆2组成，后续连杆相对于前一个连杆在一个方向进行旋转，此设备的基座连杆1进行6自由度的运动，后续连杆2都相对于前一连杆在一个方向上进行旋转，具有1个自由度的运动，即后续连杆以O
12
，O
23
，.......O
(n
‑
1)n
；连接点为轴进行一个方向的旋转；相比于后续连杆2的长度，后续连杆2之间的连接铰链长度忽略不计；
[0025]该绳驱控制方法具体包括以下步骤：
[0026]步骤一、计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标；
[0027]步骤二、根据步骤一计算得到的基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的基座连杆6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度；
[0028]步骤三、依次计算后续连杆2绳索牵引点的期望位置在世界坐标系中的坐标；
[0029]步骤四、根据步骤二计算得到的后续连杆2的绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的后续连杆2绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度；
[0030]步骤五、将步骤二得出的6根绳索各自所需的运动长度以及步骤四得出的各绳索
所需的运动长度，分别转换成电机所需旋转的角度；
[0031]步骤六、以步骤五得出的电机所需旋转的角度为基准，通过控制电机协同运动进行分别释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。
[0032]在本实施方式中，步骤一中计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标具体方法为：
[0033]步骤一一、建立基座连杆期望坐标系；所述基座连杆坐标系的原点为基座连杆1期望位置的中心点O1，基座连杆1期望位置的长度方向为基座连杆坐标系的X1轴方向，基座连杆1期望位置的宽度方向为基座连杆坐标系的Y1轴方向，基座连杆1期望位置的高度方向为基座连杆坐标系的Z1轴方向，并且基座连杆期望坐标系以O1‑
X1Y1Z1表示；
[0034]步骤一二、通过公式(1)至公式(6)计算基座连杆6个绳索牵引点的期望位置在O1‑
X1Y1Z1坐标系中的坐标；
[0035]所述本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，该绳驱控制方法是用于对多连杆设备进行操控；所述多连杆设备包括一个基座连杆(1)与多个后续连杆(2)；所述基座连杆(1)与其相邻的一个后续连杆(2)通过铰链进行连接；并且，多个后续连杆(2)之间依次通过铰链进行连接；所述基座连杆(1)采用6根绳索牵引，多个后续连杆(2)均采用1根绳索牵引，通过电机对多绳索协同控制最终实现将多连杆设备调整到期望位置；该绳驱控制方法具体包括以下步骤：步骤一、计算基座连杆(1)6个绳索牵引点的期望位置在世界坐标系中的坐标；步骤二、根据步骤一计算得到的基座连杆(1)6个绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的基座连杆(1)6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度；步骤三、依次计算后续连杆(2)绳索牵引点的期望位置在世界坐标系中的坐标；步骤四、根据步骤二计算得到的后续连杆(2)的绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的后续连杆(2)绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度；步骤五、将步骤二得出的6根绳索各自所需的运动长度以及步骤四得出的各绳索所需的运动长度，分别转换成电机所需旋转的角度；步骤六、以步骤五得出的电机所需旋转的角度为基准，通过控制电机协同运动进行分别释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。2.根据权利要求1所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤一中计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标具体方法为：步骤一一、建立基座连杆期望坐标系；所述基座连杆坐标系的原点为基座连杆(1)期望位置的中心点O1，基座连杆(1)期望位置的长度方向为基座连杆坐标系的X1轴方向，基座连杆(1)期望位置的宽度方向为基座连杆坐标系的Y1轴方向，基座连杆(1)期望位置的高度方向为基座连杆坐标系的Z1轴方向，并且基座连杆期望坐标系以O1‑
X1Y1Z1表示；步骤一二、通过公式(1)至公式(6)计算基座连杆(1)6个绳索牵引点的期望位置在O1‑
X1Y1Z1坐标系中的坐标；所述公式(1)至公式(6)为：所述公式(1)至公式(6)为：所述公式(1)至公式(6)为：所述公式(1)至公式(6)为：
其中，P
11
为第一个绳索牵引点，P
12
为第二个绳索牵引点，P
13
为第三个绳索牵引点，P
14
为第四个绳索牵引点，P
15
为第五个绳索牵引点，P
16
为第六个绳索牵引点，l1为基座连杆(1)的长度，w1为基座连杆(1)的宽度，h1为基座连杆(1)的高度；步骤一三、建立世界坐标系；该世界坐标系以O0为原点、水平向右的方向为X0轴方向、水平向前的方向为Y0轴方向以及垂直于水平面竖直向上的方向为Z0轴方向；该世界坐标系以O0‑
X0Y0Z0表示；步骤一四、根据给定的基座连杆(1)初始位置的中心点在O0‑
X0Y0Z0坐标系中的坐标(x,y,z)以及基座连杆(1)的初始姿态，并且通过公式(7)将步骤一二中计算得到的基座连杆(1)6个绳索牵引点的期望位置在O1‑
X1Y1Z1坐标系中的坐标分别转换为在O0‑
X0Y0Z0坐标系中的坐标；其中基座连杆(1)的初始姿态以其相对于其初始位置中心点的姿态角进行表示；所述基座连杆(1)相对于其初始位置中心点的姿态角为(α,β,γ)；所述公式(7)为：其中，(x
p10i
,y
p10i
,z
p10i
)为6个绳索牵引点的期望位置在O0‑
X0Y0Z0坐标系中的坐标，(x
p11i
,y
p11i
,z
p11i
)为6个绳索牵引点的期望位置在O1‑
X1Y1Z1坐标系中的坐标；i为绳索牵引点的次序数，且i＝1,2,3,4,5,6；T
01
代表从O0‑
X0Y0Z0坐标系到O1‑
X1Y1Z1坐标系的平移矩阵，R
x
(α)代表从O0‑
X0Y0Z0坐标系到O1‑
X1Y1Z1坐标系绕X0轴的旋转矩阵，R
y
(β)代表从O0‑
X0Y0Z0坐标系到O1‑
X1Y1Z1坐标系绕Y0轴的旋转矩阵，R
z
(γ)代表代表从O0‑
X0Y0Z0坐标系到O1‑
X1Y1Z1坐标系绕Z0轴的旋转矩阵，具体的：轴的旋转矩阵，具体的：3.根据权利要求2所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤二中，结合给定的基座连杆(1)6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度的具体方法为：
步骤二一、根据给定的基座连杆(1)6个绳索牵引点初始位置在O0‑
X0Y0Z0坐标系中的坐标P
o1i
(x
po1i
,y
po1i
,z
po1i
)与出绳点C
1i
在O0‑
X0Y0Z0坐标系中的点坐标(x
c01i
,y
c01i
,z
c01i
)，并利用公式(8)求解出牵引基座连杆(1)6根绳索的初始长度；所述公式(8)为：L
o1i
＝||C
1i
‑
P
o1i
||2ꢀꢀ
(8)其中，L
o1i
代表牵引基座连杆(1)6根绳索的初始长度；步骤二二、根据计算得到的基座连杆(1)6个绳索牵引点的期望位置在O0‑
X0Y0Z0坐标系中的坐标为(x
p10i
,y
p10i
,z
p10i
)与出绳点C
1i
在O0‑
X0Y0Z0坐标系中的点坐标(x
c01i
,y
c01i
,z
c01i
)，并利用公式(9)求解出牵引基座连杆(1)6根绳索的期望长度；所述公式(9)为：L
e1i
＝||C
1i
‑
P
1i
||2ꢀꢀ
(9)其中，L
e1i
代表牵引基座连杆(1)6根绳索的期望长度；P
1i
代表基座连杆(1)6个绳索牵引点的期望位置在世界坐标系中的坐标；步骤二三、根据步骤二一中求解出的6根绳索的初始长度与步骤二二中求解出的6根绳索的期望长度，并利用公式(10)求解出6根绳索各自所需的运动长度；所述公式(10)为：L
1i
＝L
e1i
‑
L
o1i
ꢀꢀ
(10)其中，L
1i
代表牵引基座连杆(1)6根绳索所需的运动长度。4.根据权利要求3所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤三中计算后续连杆(2)绳索牵引点的期望位置在世界坐标系中坐标的具体方法为：步骤三一、建立后续连杆初始位置坐标系；所述后续连杆初始位置坐标系的原点为第n根后续连杆(2)初始位置的中心点O
′
n+1
，第n根后续连杆(2)初始位置的长度方向为后续连杆初始位置坐标系的X
′
n+1
轴方向，第n根后续连杆(2)初始位置的宽度方向为后续连杆初始位置坐标系的Y
′
n+1
轴方向，第n根后续连杆(2)初始位置的高度方向为后续连杆初始位置坐标系的Z
′
n+1
轴方向，并且后续连杆初始位置坐标系以O
′
n+1
‑
X
′
n+1
Y
′
n+1
Z
′
n+1
表示；其中n为大于0的整数；步骤三二、计算第n根后续连杆(2)绳索牵引点初始位置在O
′
n+1
‑
X
′
n+1
Y
′
n+1
Z
′
n+1
坐标系中的坐标，具体的坐标为：其中，n代表后续连杆(2)的次序数，P
(n+1)1
代表第n根后续连杆(2)绳索牵引点初始位置在O
′
n+1
‑
X
′
n+1
Y
′
n+1
Z
′
n+1
坐标系中的坐标；l
n+1
代表第n个后续连杆(2)的长度，h
n+1
代表第n个后续连杆(2)的高度；步骤三三、建立后续连杆期望位置坐标系；所述后续连杆期望位置坐标系的原点为第n根后续连杆(2)期望位置的中心点O
n+1
，第n根后续连杆(2)期望位置的长度方向为后续连杆期望位置坐标系的X
n+1
轴方向，第n根后续连杆(2)期望位置的宽度方向为后续连杆期望位置坐标系的Y
n+1
轴方向，第n根后续连杆(2)期望位置的高度方向为后续连杆期望位置坐标系的Z
n+1
轴方向，并且后续连杆期望位置坐标系以O
n+1
‑
X
n+1
Y
n+1
Z
n+1
表示；
步骤三四、根据给定的第n根后续连杆(2)的相对转角θ
n
，将步骤二二中计算得到的第n根后续连杆(2)绳索牵引点初始位置在O
′
n+1
‑
X
′
n+1
Y
′
n+1
Z
′
n+1
坐标系中的坐标转换为在O
n+1
‑
X
n+1
Y
n+1
Z
n+1
坐标系中的期望坐标；具体的转换公式为：其中，(x
′
p(n+1)(n+1)1
,y
′
p(n+1)(n+1)1
,z
′
p(n+1)(n+1)1
)为绳索牵引点初始位置在O
′
n+1
‑
X
′
n+1
Y
′
n+1
Z
′
n+1
坐标系中的坐标；(x
p(n+1)(n+1)1
,y
p(n+1)(n+1)1
,z
p(n+1)(n+1)1
)为绳索牵引点在O
′
n+1
‑
X
′
n+1
Y
′
n+1
...

【专利技术属性】
技术研发人员：姚蔚然，卢彦岐，孙光辉，吴立刚，刘健行，张欧阳，田昊宇，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：