CN113352311B - 一种应用于大空间多连杆设备操控的绳驱控制方法 - Google Patents

Abstract

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

Description

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

技术领域

本发明涉及一种绳驱机器人装配技术。

背景技术

随着生产经济发展，大空间多连杆设备的装配问题逐渐成为主要装配问题，例如多关节机械臂的装配任务，以及工厂大型连杆设备的组装任务；就这些任务而言主要是如何完成大空间同步移动以及连杆可变姿态的装配任务。

目前进行大型连杆设备的装配主要采用刚性支架或刚性连杆进行分段式安装，这种装配方法导致被装设备可移动范围狭小，可变姿态的范围十分有限。

发明内容

本发明的目的是为了解决现有的大型连杆设备的装配过程中，被装设备可移动范围狭小，可变姿态的范围十分有限的问题，提出了一种应用于大空间多连杆设备操控的绳驱控制方法。

本发明所述的一种应用于大空间多连杆设备操控的绳驱控制方法，该绳驱控制方法是基于多连杆设备操控的绳驱控制装置实现的；该绳驱控制方法是用于对多连杆设备进行操控；所述多连杆设备包括一个基座连杆与多个后续连杆；

所述基座连杆与其相邻的一个后续连杆通过铰链进行连接；并且，多个后续连杆之间依次通过铰链进行连接；

所述基座连杆采用6根绳索牵引，多个后续连杆均采用1根绳索牵引，通过电机对多绳索协同控制最终实现将多连杆设备调整到期望位置；

该绳驱控制方法具体包括以下步骤：

步骤一、计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标；

步骤二、根据步骤一计算得到的基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的基座连杆6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度；

步骤三、依次计算后续连杆绳索牵引点的期望位置在世界坐标系中的坐标；

步骤四、根据步骤二计算得到的后续连杆的绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的后续连杆绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度；

步骤五、将步骤二得出的6根绳索各自所需的运动长度以及步骤四得出的各绳索所需的运动长度，分别转换成电机所需旋转的角度；

步骤六、以步骤五得出的电机所需旋转的角度为基准，通过控制电机协同运动进行分别释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。

本发明的有益效果是：在大空间范围移动，多绳索协同控制，多连杆设备姿态可变三个主要方面；

1大空间范围移动：通过绳索的柔性以及轻质量特性，实现超大空间的绳索部署，从而实现超大范围的移动。

2多绳索协同控制：采用多绳索集群协同控制，可以实现更为复杂的运动，可以完成自由度更多的物体移动任务，稳定性更高。

3多连杆设备姿态可变：可以实现多连杆设备位置以及姿态的多自由度变化，完成更加复杂，更加灵活的装配任务需求。

附图说明

图1为具体实施方式一所述的一种应用于大空间多连杆设备操控的绳驱控制装置结构示意图；其中，基座连杆的长为l₁，宽为w₁，高为h₁，O₁-X₁Y₁Z₁为以基座连杆中心所建立的坐标系，P₁₁，P₁₂，P₁₃，P₁₄，P₁₅，P₁₆为基座连杆的绳索牵引点，C₁₁，C₁₂，C₁₃，C₁₄，C₁₅，C₁₆为绳驱系统连接基座连杆的出绳点；

图2为具体实施方式一所述的一种应用于大空间多连杆设备操控的绳驱控制方法流程图；

图3为具体实施方式一中对基座连杆期望位置调整的具体流程图。

具体实施方式

具体实施方式一：结合图1至图3说明本实施方式，本实施方式所述的一种应用于大空间多连杆设备操控的绳驱控制方法，该绳驱控制方法是用于对多连杆设备进行操控；所述多连杆设备包括一个基座连杆1与多个后续连杆2；

所述基座连杆1与其相邻的一个后续连杆2通过铰链进行连接；并且，多个后续连杆2之间依次通过铰链进行连接；

所述基座连杆1采用6根绳索牵引，多个后续连杆2均采用1根绳索牵引，通过电机对多绳索协同控制最终实现将多连杆设备调整到期望位置；基座连杆1或后续连杆2与牵引绳索的连接点为牵引点；考虑多连杆设备是由一个基座连杆1与多个后续连杆2组成，后续连杆相对于前一个连杆在一个方向进行旋转，此设备的基座连杆1进行6自由度的运动，后续连杆2都相对于前一连杆在一个方向上进行旋转，具有1个自由度的运动，即后续连杆以O₁₂，O₂₃，.......O_(n-1)n；连接点为轴进行一个方向的旋转；相比于后续连杆2的长度，后续连杆2之间的连接铰链长度忽略不计；

该绳驱控制方法具体包括以下步骤：

步骤一、计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标；

步骤二、根据步骤一计算得到的基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的基座连杆6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度；

步骤三、依次计算后续连杆2绳索牵引点的期望位置在世界坐标系中的坐标；

步骤四、根据步骤二计算得到的后续连杆2的绳索牵引点的期望位置在世界坐标系中的坐标，并结合给定的后续连杆2绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度；

步骤五、将步骤二得出的6根绳索各自所需的运动长度以及步骤四得出的各绳索所需的运动长度，分别转换成电机所需旋转的角度；

步骤六、以步骤五得出的电机所需旋转的角度为基准，通过控制电机协同运动进行分别释放或收缩绳索，最终使整体多连杆设备完成调整到期望位置。

在本实施方式中，步骤一中计算基座连杆6个绳索牵引点的期望位置在世界坐标系中的坐标具体方法为：

步骤一一、建立基座连杆期望坐标系；所述基座连杆坐标系的原点为基座连杆1期望位置的中心点O₁，基座连杆1期望位置的长度方向为基座连杆坐标系的X₁轴方向，基座连杆1期望位置的宽度方向为基座连杆坐标系的Y₁轴方向，基座连杆1期望位置的高度方向为基座连杆坐标系的Z₁轴方向，并且基座连杆期望坐标系以O₁-X₁Y₁Z₁表示；

步骤一二、通过公式(1)至公式(6)计算基座连杆6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标；

所述公式(1)至公式(6)为：

其中，P₁₁为第一个绳索牵引点，P₁₂为第二个绳索牵引点，P₁₃为第三个绳索牵引点，P₁₄为第四个绳索牵引点，P₁₅为第五个绳索牵引点，P₁₆为第六个绳索牵引点，l₁为基座连杆1的长度，w₁为基座连杆1的宽度，h₁为基座连杆1的高度；

步骤一三、建立世界坐标系；该世界坐标系以O₀为原点、水平向右的方向为X₀轴方向、水平向前的方向为Y₀轴方向以及垂直于水平面竖直向上的方向为Z₀轴方向；该世界坐标系以O₀-X₀Y₀Z₀表示；

步骤一四、根据给定的基座连杆1初始位置的中心点在O₀-X₀Y₀Z₀坐标系中的坐标(x,y,z)以及基座连杆1的初始姿态，并且通过公式7将步骤一二中计算得到的基座连杆6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标分别转换为在O₀-X₀Y₀Z₀坐标系中的坐标；其中基座连杆1的初始姿态以其相对于其初始位置中心点的姿态角进行表示；所述基座连杆1相对于其初始位置中心点的姿态角为(α,β,γ)；

所述公式(7)为：

其中，(x_p10i,y_p10i,z_p10i)为6个绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标，(x_p11i,y_p11i,z_p11i)为6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标；i为绳索牵引点的次序数，且i＝1,2,3,4,5,6；T₀₁代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系的平移矩阵，R_x(α)代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕X₀轴的旋转矩阵，R_y(β)代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕Y₀轴的旋转矩阵，R_z(γ)代表代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕Z₀轴的旋转矩阵，具体的：

在本实施方式中，步骤二中，结合给定的基座连杆16个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度的具体方法为：

步骤二一、根据给定的基座连杆16个绳索牵引点初始位置在O₀-X₀Y₀Z₀坐标系中的坐标P_o1i(x_po1i,y_po1i,z_po1i)与出绳点C_1i在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c01i,y_c01i,z_c01i)，并利用公式(8)求解出牵引基座连杆16根绳索的初始长度；

所述公式(8)为：

L_o1i＝||C_1i-P_o1i||₂ (8)

其中，L_o1i代表牵引基座连杆16根绳索的初始长度；

步骤二二、根据计算得到的基座连杆16个绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标为(x_p10i,y_p10i,z_p10i)与出绳点C_1i在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c01i,y_c01i,z_c01i)，并利用公式(9)求解出牵引基座连杆16根绳索的期望长度；

所述公式(9)为：

L_e1i＝||C_1i-P_1i||₂ (9)

其中，L_e1i代表牵引基座连杆16根绳索的期望长度；P_1i代表基座连杆16个绳索牵引点的期望位置在世界坐标系中的坐标；

步骤二三、根据步骤二一中求解出的6根绳索的初始长度与步骤二二中求解出的6根绳索的期望长度，并利用公式(10)求解出6根绳索各自所需的运动长度；

所述公式(10)为：

L_1i＝L_e1i-L_o1i (10)

其中，L_1i代表牵引基座连杆16根绳索所需的运动长度。

在本实施方式中，步骤三中计算后续连杆(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+1Y′_n+1Z′_n+1表示；其中n为大于0的整数；

步骤三二、计算第n根后续连杆2绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系中的坐标，具体的坐标为：

其中，n代表后续连杆2的次序数，P_(n+1)1代表第n根后续连杆2绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_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+1Y_n+1Z_n+1表示；

步骤三四、根据给定的第n根后续连杆2的相对转角θ_n，将步骤二二中计算得到的第n根后续连杆2绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系中的坐标转换为在O_n+1-X_n+1Y_n+1Z_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+1Y′_n+1Z′_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+1Y′_n+1Z′_n+1坐标系中的期望坐标；T_{(n+1)(n+1)′}T_nn′代表从O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系到O_n+1-X_n+1Y_n+1Z_n+1坐标系的平移矩阵，R_y(θ_n)代表从O_n+1-X_n+1Y_n+1Z_n+1坐标系到O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系绕Y_n+1轴的旋转矩阵，具体的：

步骤三五、将步骤二四中得到的第n根后续连杆2绳索牵引点初始位置在O_n+1-X_{n+ 1}Y_n+1Z_n+1坐标系中的期望坐标依次递减转换，直到转换为相对于O₁-X₁Y₁Z₁坐标系的坐标；

具体的转换公式为：

其中，T_n′(n+1)代表从O′_n-X′_nY′_nZ′_n坐标系到O_n+1-X_n+1Y_n+1Z_n+1坐标系的平移矩阵；具体的

其余绳索牵引点P_(n+1)1转换为相对于O′_n-X′_nY′_nZ′_n坐标系期望位置的坐标为(x_p(n+1)n1,y_p(n+1)n1,z_p(n+1)n1)，相对于O′_n-1-X′_n-1Y′_n-1Z′_n-1坐标系的坐标(x′_p(n+1)(n-1)1,y′_p(n+1)(n-1)1,z′_p(n+1)(n-1)1)，直到绳索牵引点P_(n+1)1转换为相对于O₁-X₁Y₁Z₁坐标系的期望坐标(x_p(n+1)11,y_p(n+)11,z_p(n+1)11)；

步骤三六、将绳索牵引点P_(n+1)1相对于O₀-X₀Y₀Z₀坐标系期望位置的坐标为(x_p(n+1)01,y_p(n+1)01,z_p(n+1)01)可由下述公式得到：

其中

在本实施方式中，由于计算每根后续连杆2的每个绕绳点在世界坐标系中的坐标，后续连杆2的连接方式与自由度均相同，因此计算方式也相通，因此考虑到通用性，以n取不同的值即可实现；

在本实施方式中，步骤四中结合给定的后续连杆2绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度的具体方法为：

步骤四一、根据给定的后续连杆2绳索牵引点初始位置在O₀-X₀Y₀Z₀坐标系中的坐标P_o(n+1)1(x_po(n+1)1,y_po(n+1)1,z_po(n+1)1)与出绳点C_(n+1)1在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c0(n+1)1,y_c0(n+1)1,z_c0(n+1)1)，并利用公式11求解出牵引后续连杆2绳索的初始长度；

所述公式(11)为：

L_o(n+1)1＝||C_(n+1)1-P_o(n+1)1||₂ (11)

其中，L_o(n+1)1代表牵引后续连杆2绳索的初始长度；

步骤四二、根据计算得到的后续连杆2绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标为(x_p(n+1)01,y_p(n+1)01,z_p(n+1)01)与出绳点C_(n+1)1在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c0(n+1)1,y_c0(n+1)1,z_c0(n+1)1)，并利用公式(12)求解出牵引后续连杆2绳索的期望长度；

所述公式(12)为：

L_e(n+1)1＝||C_(n+1)1-P_(n+1)1||₂ (12)

其中，L_e1i代表牵引后续连杆2绳索的期望长度；P_(n+1)1代表后牵引续连杆2绳索牵引点的期望位置在世界坐标系中的坐标；

步骤四三、根据步骤四一中求解出的牵引后续连杆2绳索的初始长度与步骤四二中求解出的牵引后续连杆2绳索的期望长度，并利用公式(13)求解出牵引后续连杆2绳索绳索所需的运动长度；

所述公式(13)为：

L_(n+1)1＝L_e(n+1)1-L_o(n+1)1 (13)

其中，L_(n+1)1代表牵引后续连杆2绳索所需的运动长度。

在本实施方式中，步骤五中将步骤二得出的6根绳索各自所需的运动长度转换成电机所需旋转的角度的具体公式为：

其中，ω_1i为控制牵引基座连杆16根绳索的电机所需旋转的角度；M₁为控制牵引基座连杆16根绳索的电机的减速比，N₁为控制牵引基座连杆16根绳索传动装置的传动比，R₁为控制牵引基座连杆16根绳索的电机转轴半径；

步骤五中将步骤四得出的牵引绳索所需的运动长度转换成电机所需旋转的角度的具体公式为：

其中，ω_(n+1)1为控制牵引后续连杆2绳索的电机所需旋转的角度；M_n+1为控制牵引后续连杆2绳索的电机的减速比，N_n+1为控制牵引后续连杆2绳索传动装置的传动比，R_n+1为控制牵引后续连杆2绳索的电机转轴半径。

在本实施方式中，步骤六中使整体多连杆设备完成调整到期望位置的具体步骤为：

步骤六一、将基座连杆1由初始位置调整至期望位置；

步骤六二、依次将第一根后续连杆2至第m根后续连杆2由初始位置调整至期望位置，所述m为大于1的整数。

在本实施方式中，步骤六一中将基座连杆1由初始位置调整至期望位置的具体步骤为：

步骤六一一、控制牵引基座连杆1绳索的电机旋转ω_1i；

步骤六一二、通过电机的编码器测量各电机轴实际运动总距离，根据各电机轴实际运动总距离与绳索所需运动长度进行对比，计算出牵引基座连杆1的各绳索运动距离的总偏差E_1i；

步骤六一三、判断步骤六一二中的总偏差E_1i是否为0；如果总偏差E_1i为0，则完成对基座连杆1期望位置的调整；否则，执行步骤六一四；

步骤六一四、控制各电机进行负反馈运动，取牵引基座连杆1的各绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_1ip；

步骤六一五、判断步骤六一四中的当前偏差E_1jp是否为0；如果，E_1jp为0，则返回执行步骤六一二；否则，执行步骤六一四。

在本实施方式中，步骤六二中将第一根后续连杆2由初始位置调整至期望位置的具体步骤为：

步骤六二一、控制牵引第一根后续连杆2绳索的电机按照计算后得出的需旋转的角度进行旋转；

步骤六二二、通过电机的编码器测量电机轴实际运动总距离，根据各电机轴实际运动总距离与绳索所需运动长度进行对比，计算出牵引后续连杆2的绳索运动距离的总偏差E₂₁；

步骤六二三、判断步骤六二二中的总偏差E₂₁是否为0；如果总偏差E₂₁为0，则完成对后续连杆2期望位置的调整；否则，执行步骤六二四；

步骤六二四、控制各电机进行负反馈运动，取牵引后续连杆2的绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_21p；

步骤六二五、判断步骤六二四中的当前偏差E_21p是否为0；如果，E_21p为0，则返回执行步骤六二二；否则，执行步骤六二四。

在本实施方式中，步骤六二中将第m根后续连杆2由初始位置调整至期望位置的具体步骤为：

步骤Ⅰ、控制牵引第m根后续连杆2绳索的电机按照计算后得出的需旋转的角度进行旋转；

步骤Ⅱ、通过第m根后续连杆2绳驱电机的编码器测量该电机实际运动总距离，根据该电机轴实际运动距离与绳索所需运动长度进行对比，计算出连接第m根后续连杆2的绳索运动距离的偏差E_(m+1)1；

步骤Ⅲ、判断步骤Ⅱ中的偏差E_(m+1)1是否为0；如果偏差E_(m+1)1为0，则完成对第m根后续连杆2期望位置的调整；否则，执行步骤Ⅳ；

步骤Ⅳ、控制各电机进行负反馈运动，取连接第m根后续连杆2的绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_(m+1)1p；

步骤Ⅴ、判断步骤Ⅳ中的当前偏差E_(m+1)1p是否为0；如果，E_(m+1)1p为0，则返回执行步骤Ⅱ；否则，执行步骤Ⅳ。

Claims (10)

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)期望位置的中心点O₁，基座连杆(1)期望位置的长度方向为基座连杆期望坐标系的X₁轴方向，基座连杆(1)期望位置的宽度方向为基座连杆期望坐标系的Y₁轴方向，基座连杆(1)期望位置的高度方向为基座连杆期望坐标系的Z₁轴方向，并且基座连杆期望坐标系以O₁-X₁Y₁Z₁表示；

步骤一二、通过公式(1)至公式(6)计算基座连杆(1)6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标；

所述公式(1)至公式(6)为：

其中，P₁₁为第一个绳索牵引点，P₁₂为第二个绳索牵引点，P₁₃为第三个绳索牵引点，P₁₄为第四个绳索牵引点，P₁₅为第五个绳索牵引点，P₁₆为第六个绳索牵引点，l₁为基座连杆(1)的长度，w₁为基座连杆(1)的宽度，h₁为基座连杆(1)的高度；

步骤一三、建立世界坐标系；该世界坐标系以O₀为原点、水平向右的方向为X₀轴方向、水平向前的方向为Y₀轴方向以及垂直于水平面竖直向上的方向为Z₀轴方向；该世界坐标系以O₀-X₀Y₀Z₀表示；

步骤一四、根据给定的基座连杆(1)初始位置的中心点在O₀-X₀Y₀Z₀坐标系中的坐标(x,y,z)以及基座连杆(1)的初始姿态，并且通过公式(7)将步骤一二中计算得到的基座连杆(1)6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标分别转换为在O₀-X₀Y₀Z₀坐标系中的坐标；其中基座连杆(1)的初始姿态以其相对于其初始位置中心点的姿态角进行表示；所述基座连杆(1)相对于其初始位置中心点的姿态角为(α,β,γ)；

所述公式(7)为：

其中，(x_p10i,y_p10i,z_p10i)为6个绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标，(x_p11i,y_p11i,z_p11i)为6个绳索牵引点的期望位置在O₁-X₁Y₁Z₁坐标系中的坐标；i为绳索牵引点的次序数，且i＝1,2,3,4,5,6；T₀₁代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系的平移矩阵，R_x(α)代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕X₀轴的旋转矩阵，R_y(β)代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕Y₀轴的旋转矩阵，R_z(γ)代表代表从O₀-X₀Y₀Z₀坐标系到O₁-X₁Y₁Z₁坐标系绕Z₀轴的旋转矩阵，具体的：

3.根据权利要求2所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤二中，结合给定的基座连杆(1)6个绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出6根绳索各自所需的运动长度的具体方法为：

步骤二一、根据给定的基座连杆(1)6个绳索牵引点初始位置在O₀-X₀Y₀Z₀坐标系中的坐标P_o1i(x_po1i,y_po1i,z_po1i)与出绳点C_1i在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c01i,y_c01i,z_c01i)，并利用公式(8)求解出牵引基座连杆(1)6根绳索的初始长度；

所述公式(8)为：

L_o1i＝||C_1i-P_o1i||₂ (8)

其中，L_o1i代表牵引基座连杆(1)6根绳索的初始长度；

步骤二二、根据计算得到的基座连杆(1)6个绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标为(x_p10i,y_p10i,z_p10i)与出绳点C_1i在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c01i,y_c01i,z_c01i)，并利用公式(9)求解出牵引基座连杆(1)6根绳索的期望长度；

所述公式(9)为：

L_e1i＝||C_1i-P_1i||₂ (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+1Y′_n+1Z′_n+1表示；其中n为大于0的整数；

步骤三二、计算第n根后续连杆(2)绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系中的坐标，具体的坐标为：

其中，n代表后续连杆(2)的次序数，P_(n+1)1代表第n根后续连杆(2)绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_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+1Y_n+1Z_n+1表示；

步骤三四、根据给定的第n根后续连杆(2)的相对转角θ_n，将步骤三二中计算得到的第n根后续连杆(2)绳索牵引点初始位置在O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系中的坐标转换为在O_n+1-X_n+1Y_n+1Z_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+1Z′_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+1Y′_n+1Z′_n+1坐标系中的期望坐标；T_{(n+1)(n+1)′}代表从O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系到O_n+1-X_{n+ 1}Y_n+1Z_n+1坐标系的平移矩阵，R_y(θ_n)代表从O_n+1-X_n+1Y_n+1Z_n+1坐标系到O′_n+1-X′_n+1Y′_n+1Z′_n+1坐标系绕Y_n+1轴的旋转矩阵，具体的：

步骤三五、将步骤三四中得到的第n根后续连杆(2)绳索牵引点初始位置在O_n+1-X_n+1Y_{n+ 1}Z_n+1坐标系中的期望坐标依次递减转换，直到转换为相对于O₁-X₁Y₁Z₁坐标系的坐标；

具体的转换公式为：

其中，T_n′(n+1)代表从O′_n-X′_nY′_nZ′_n坐标系到O_n+1-X_n+1Y_n+1Z_n+1坐标系的平移矩阵；具体的

其余绳索牵引点P_(n+1)1转换为相对于O′_n-X′_nY′_nZ′_n坐标系期望位置的坐标为(x_p(n+1)n1,y_p(n+1)n1,z_p(n+1)n1)，相对于O′_n-1-X′_n-1Y′_n-1Z′_n-1坐标系的坐标(x′_p(n+1)(n-1)1,y′_p(n+1)(n-1)1,z′_p(n+1)(n-1)1)，直到绳索牵引点P_(n+1)1转换为相对于O₁-X₁Y₁Z₁坐标系的期望坐标(x_p(n+1)11,y_p(n+)11,z_p(n+1)11)；

步骤三六、将绳索牵引点P_(n+1)1相对于O₀-X₀Y₀Z₀坐标系期望位置的坐标为(x_p(n+1)01,y_p(n+1)01,z_p(n+1)01)可由下述公式得到：

其中

5.根据权利要求4所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤四中结合给定的后续连杆(2)绳索牵引点初始位置在世界坐标系中的坐标通过逆运动学求解出其牵引绳索所需的运动长度的具体方法为：

步骤四一、根据给定的后续连杆(2)绳索牵引点初始位置在O₀-X₀Y₀Z₀坐标系中的坐标P_o(n+1)1(x_po(n+1)1,y_po(n+1)1,z_po(n+1)1)与出绳点C_(n+1)1在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c0(n+1)1,y_c0(n+1)1,z_c0(n+1)1)，并利用公式(11)求解出牵引后续连杆(2)绳索的初始长度；

所述公式(11)为：

L_o(n+1)1＝||C_(n+1)1-P_o(n+1)1||₂ (11)

其中，L_o(n+1)1代表牵引后续连杆(2)绳索的初始长度；

步骤四二、根据计算得到的后续连杆(2)绳索牵引点的期望位置在O₀-X₀Y₀Z₀坐标系中的坐标为(x_p(n+1)01,y_p(n+1)01,z_p(n+1)01)与出绳点C_(n+1)1在O₀-X₀Y₀Z₀坐标系中的点坐标(x_c0(n+1)1,y_c0(n+1)1,z_c0(n+1)1)，并利用公式(12)求解出牵引后续连杆(2)绳索的期望长度；

所述公式(12)为：

L_e(n+1)1＝||C_(n+1)1-P_(n+1)1||₂ (12)

其中，L_e(n+1)1代表牵引后续连杆(2)绳索的期望长度；P_(n+1)1代表牵引后续连杆(2)绳索牵引点的期望位置在世界坐标系中的坐标；

步骤四三、根据步骤四一中求解出的牵引后续连杆(2)绳索的初始长度与步骤四二中求解出的牵引后续连杆(2)绳索的期望长度，并利用公式(13)求解出牵引后续连杆(2)绳索绳索所需的运动长度；

所述公式(13)为：

L_(n+1)1＝L_e(n+1)1-L_o(n+1)1 (13)

其中，L_(n+1)1代表牵引后续连杆(2)绳索所需的运动长度。

6.根据权利要求5所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤五中将步骤二得出的6根绳索各自所需的运动长度转换成电机所需旋转的角度的具体公式为：

其中，ω_1i为控制牵引基座连杆(1)6根绳索的电机所需旋转的角度；M₁为控制牵引基座连杆(1)6根绳索的电机的减速比，N₁为控制牵引基座连杆(1)6根绳索传动装置的传动比，R₁为控制牵引基座连杆(1)6根绳索的电机转轴半径；

步骤五中将步骤四得出的牵引绳索所需的运动长度转换成电机所需旋转的角度的具体公式为：

其中，ω_(n+1)1为控制牵引后续连杆(2)绳索的电机所需旋转的角度；M_n+1为控制牵引后续连杆(2)绳索的电机的减速比，N_n+1为控制牵引后续连杆(2)绳索传动装置的传动比，R_n+1为控制牵引后续连杆(2)绳索的电机转轴半径。

7.根据权利要求6所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤六中使整体多连杆设备完成调整到期望位置的具体步骤为：

步骤六一、将基座连杆(1)由初始位置调整至期望位置；

步骤六二、依次将第一根后续连杆(2)至第m根后续连杆(2)由初始位置调整至期望位置，所述m为大于1的整数。

8.根据权利要求7所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤六一中将基座连杆(1)由初始位置调整至期望位置的具体步骤为：

步骤六一一、控制牵引基座连杆(1)绳索的电机旋转ω_1i；

步骤六一二、通过电机的编码器测量各电机轴实际运动总距离，根据各电机轴实际运动总距离与绳索所需运动长度进行对比，计算出牵引基座连杆(1)的各绳索运动距离的总偏差E_1i；

步骤六一三、判断步骤六一二中的总偏差E_1i是否为0；如果总偏差E_1i为0，则完成对基座连杆(1)期望位置的调整；否则，执行步骤六一四；

步骤六一四、控制各电机进行负反馈运动，取牵引基座连杆(1)的各绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_1ip；

步骤六一五、判断步骤六一四中的当前偏差E_1ip是否为0；如果，E_1ip为0，则返回执行步骤六一二；否则，执行步骤六一四。

9.根据权利要求7或8所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤六二中将第一根后续连杆(2)由初始位置调整至期望位置的具体步骤为：

步骤六二一、控制牵引第一根后续连杆(2)绳索的电机按照计算后得出的需旋转的角度进行旋转；

步骤六二二、通过电机的编码器测量电机轴实际运动总距离，根据各电机轴实际运动总距离与绳索所需运动长度进行对比，计算出牵引后续连杆(2)的绳索运动距离的总偏差E₂₁；

步骤六二三、判断步骤六二二中的总偏差E₂₁是否为0；如果总偏差E₂₁为0，则完成对后续连杆(2)期望位置的调整；否则，执行步骤六二四；

步骤六二四、控制各电机进行负反馈运动，取牵引后续连杆(2)的绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_21p；

步骤六二五、判断步骤六二四中的当前偏差E_21p是否为0；如果，E_21p为0，则返回执行步骤六二二；否则，执行步骤六二四。

10.根据权利要求9所述的一种应用于大空间多连杆设备操控的绳驱控制方法，其特征在于，步骤六二中将第m根后续连杆(2)由初始位置调整至期望位置的具体步骤为：

步骤Ⅰ、控制牵引第m根后续连杆(2)绳索的电机按照计算后得出的需旋转的角度进行旋转；

步骤Ⅱ、通过第m根后续连杆(2)绳驱电机的编码器测量该电机实际运动总距离，根据该电机轴实际运动距离与绳索所需运动长度进行对比，计算出连接第m根后续连杆(2)的绳索运动距离的偏差E_(m+1)1；

步骤Ⅲ、判断步骤Ⅱ中的偏差E_(m+1)1是否为0；如果偏差E_(m+1)1为0，则完成对第m根后续连杆(2)期望位置的调整；否则，执行步骤Ⅳ；

步骤Ⅳ、控制各电机进行负反馈运动，取连接第m根后续连杆(2)的绳索一次运动的最小步长作为期望距离，通过电机编码器测量当前电机轴运动距离与期望距离进行作差，计算出当前偏差E_(m+1)1p；

步骤Ⅴ、判断步骤Ⅳ中的当前偏差E_(m+1)1p是否为0；如果，E_(m+1)1p为0，则返回执行步骤Ⅱ；否则，执行步骤Ⅳ。

Images