并联式六自由度运动平台控制系统与控制方法与流程

1.本发明涉及六自由度运动平台技术领域，尤其是基于电机与摆臂连杆驱动的六自由度运动平台，具体而言涉及一种并联式六自由度运动平台控制系统与控制方法。


背景技术：

2.六自由度并联运动平台通常是由上下平台以及铰接在上下平台之间的六条伸缩缸(例如电动缸或者液压缸)构成，六条伸缩缸之间成并联方式布置，通过控制系统控制六条伸缩缸的伸缩运动来控制运动平台在空间内的多个自由度的运动姿态的调整。
3.通常工业上应用的六自由度并联运动平台都具有较大的体积和重量，在家用或者轻量化、小体积的场景下难以进行适用，例如家用或者小场所娱乐设施、驾驶体感模拟、游戏、养生、康复等设备中，难以实现应用。
4.同时，现有的六自由度并联机器人得反解控制主要通过余弦定理和反三角计算获得，通过这些方法获得的是近似解，控制其精度较低。


技术实现要素：

5.本发明目的在于提供一种并联式六自由度运动平台控制系统与控制方法，优化平台设计和运动控制结算，实现轻量化、小体积的设计要求以及高精度可靠的运动控制。
6.为实现上述目的，本发明的第一方面提出一种并联式六自由度运动平台控制系统，包括：
7.基座；
8.运动平台；
9.设置在基座与运动平台之间的六个并联式设计的电机-连杆驱动机构，通过电机-连杆驱动机构的运动驱动运动平台的在空间内的六个自由度的运动；
10.其中，所述运动平台包括三个l形的支撑架，相互之间成度配置；其中三个支撑架采用相同的结构设计，均具有竖梁以及与竖梁连接的横梁；三个横梁的端部以围绕基座的中心点为中心，拼接在一起，使得运动平台构成为一体结构，并且由l形的支撑架拼接形成的空间作为座椅的容纳和安装空间；
11.每个l形的支撑架的竖梁的顶部设置有一对虎克铰，分别与一对电机-连杆驱动机构铰接，以根据来自电机-连杆驱动机构的力矩而驱动运动平台的l形的支撑架的运动，调整其空间姿态，从而调整座椅的空间姿态。
12.在可选的实施例中，控制系统通过建立全局坐标系o0xyz，实现运动过程中摆臂的向上运动和向下运动的驱动控制，其中全局坐标系o0xyz的原点建立在上铰接圆圆心处，y轴正方向指向座椅正前方，z轴正方向垂直上铰接圆平面向上。
13.应当理解，前述构思以及在下面更加详细地描述的额外构思的所有组合只要在这样的构思不相互矛盾的情况下都可以被视为本公开的发明主题的一部分。另外，所要求保护的主题的所有组合都被视为本公开的发明主题的一部分。
14.结合附图从下面的描述中可以更加全面地理解本发明教导的前述和其他方面、实施例和特征。本发明的其他附加方面例如示例性实施方式的特征和/或有益效果将在下面的描述中显见，或通过根据本发明教导的具体实施方式的实践中得知。
附图说明
15.附图不意在按比例绘制。在附图中，在各个图中示出的每个相同或近似相同的组成部分可以用相同的标号表示。为了清晰起见，在每个图中，并非每个组成部分均被标记。现在，将通过例子并参考附图来描述本发明的各个方面的实施例，其中：
16.图1是本发明示例性实施例的并联式六自由度运动平台的示意图。
17.图2是本发明示例性实施例的并联式六自由度运动平台的驾驶操作模拟的示意图。
18.图3是对图1所示实施例的并联式六自由度运动平台建立全局坐标系与局部坐标系示意图。
19.图4是图1所示实施例的并联式六自由度运动平台的下铰接圆的示意图。
20.图5是图1所示实施例的并联式六自由度运动平台的上铰接圆的示意图。
21.图6-7是图1所示实施例的并联式六自由度运动平台的仿真结果示意图，其中图6是x， y，z方向移动行程的示意图，图7是α，β，γ转动角度的示意图。
具体实施方式
22.为了更了解本发明的技术内容，特举具体实施例并配合所附图式说明如下。
23.在本公开中参照附图来描述本发明的各方面，附图中示出了许多说明的实施例。本公开的实施例不必定意在包括本发明的所有方面。应当理解，上面介绍的多种构思和实施例，以及下面更加详细地描述的那些构思和实施方式可以以很多方式中任意一种来实施，这是因为本发明所公开的构思和实施例并不限于任何实施方式。另外，本发明公开的一些方面可以单独使用，或者与本发明公开的其他方面的任何适当组合来使用。
24.结合图1-5所示实施例的基于电机与摆臂连杆驱动的并联式六自由度运动平台，其包括基座110、运动平台120以及设置在基座110与运动平台120之间的六个并联式设计的电机
‑ꢀ
连杆驱动机构，通过电机-连杆驱动机构的运动驱动运动平台120的在空间内的六个自由度的运动。
25.如图1所示，基座110采用框架式结构。基座110、运动平台120可采用高强度的钢结构制作。
26.如图1、2所示，运动平台120包括三个l形的支撑架121，相互之间成120度配置。
27.三个支撑架121采用相同的结构设计，具有竖梁122以及与竖梁连接的横梁124。
28.三个横梁124的端部以围绕基座110的中心点为中心，拼接在一起，使得运动平台120 构成为一体结构，并且由l形的支撑架121拼接形成的空间作为座椅120的容纳和安装空间。
29.结合图1、3，每个支撑架121的竖梁122的顶部(即其上部)设置有一对虎克铰135，分别与一对电机-连杆驱动机构铰接，以根据来自电机-连杆驱动机构的力矩而驱动运动平台 120的l形的支撑架121的运动，调整其空间姿态。
30.结合图1、3所示，每一组电机-连杆驱动机构包括固定到基座110上的电机130、摆臂 131以及连杆133，连杆133的一端与虎克铰135铰接，另一端经由鱼眼轴承132与摆臂133 的一端连接，电机130的输出轴与摆臂133的另一端连接，由此，电机130的转动过程中，驱动摆臂133同步转动，并驱使连杆133受驱动而做相应运动。
31.结合图1、3所示，每一组电机-连杆驱动机构中，连杆133与运动平台120通过虎克铰连接，定义虎克铰的两旋转轴的交点为运动平台铰接点，即铰接点c。摆臂131与连杆133 通过鱼眼轴承132连接，鱼眼轴承132的旋转中心点为摆臂末端点，即铰接点b。摆臂131 的轴线与电机转子轴线交点为基座铰接点，即铰接点a。
32.结合图4、5所示，6个运动平台铰接点在一个圆上，该圆为上铰接圆。6个基座铰接点在一个圆上，该圆为下铰接圆。
33.优选地，六个电机130采用相同的型号参数设计，均采用高精度的步进电机。
34.在可选的实施例中，电机130经过减速机减速后，与前述的摆臂131驱动地连接。
35.结合图1、3、4、5所示，在上述基于电机与摆臂连杆驱动的并联式六自由度运动平台的控制过程中，通过建立全局坐标系o0xyz，实现运动过程中摆臂的向上运动和向下运动的驱动控制。
36.作为可选的示例，前述并联式六自由度运动平台的控制过程包括：
37.步骤一、预先定义每个虎克铰135的两旋转轴的交点为“运动平台铰接点”，鱼眼轴承132 的旋转中心点为“摆臂末端点”，摆臂131的轴线与电机130的转子轴线交点为“基座铰接点”。 6个运动平台铰接点(铰接点c)在一个圆上，该圆为上铰接圆。6个基座铰接点(铰接点a) 在一个圆上，该圆为下铰接圆；
38.步骤二、建立全局坐标系o0xyz，全局坐标系原点建立在上铰接圆圆心处，y轴正方向指向座椅正前方，z轴正方向垂直铰接圆平面向上；
39.步骤三、在初始状态下的零位时，第i个运动平台铰接点在全局坐标系o0xyz下的坐标为[x
0i
，y
0i
，z
0i
]，第i个基座铰接点在全局坐标系o0xyz下的坐标为[x
bi
，y
bi
，z
bi
]，第i 个摆臂末端点在全局坐标系o0xyz下的坐标为[x
mi
，y
mi
，z
mi
]，计算运动平台120做[x，y， z，α，β，γ]运动后，第i个上铰接点在全局坐标系o0xyz下的坐标为(x
1i
，y
1i
，z
1i
)：
[0040][0041][0042]
步骤四、以任一个基座铰接点为球心，摆臂长度l为半径，建立第i个摆臂末端所在球面的方程：
[0043]
(x
i-x
bi
)2 (y
i-y
bi
)2 (z
i-z
bi
)2＝l2；
[0044]
步骤五、建立第i个摆臂末端点轨迹圆所在平面的平面方程，表示为：
[0045]ai
xi biyi cizi di＝0；
[0046]
步骤六、运动平台120做[x，y，z，α，β，γ]运动后，第i个运动平台铰接点(x
1i
，y
1i
， z
1i
)距离摆臂末端的距离为s，s为连杆长度，s已知，可得到方程：
[0047]
(x
i-x
1i
)2 (y
i-y
1i
)2 (z
i-z
ii
)2＝s2；
[0048]
步骤七、联合步骤四、步骤五、步骤六所列方程，求解xi，yi，zi；
[0049]
步骤八、确定步骤七所求三个未知数均有2组解：
[0050][0051][0052][0053]
步骤九、建立零位摆臂空间向量ui，表示为：
[0054]
ui＝[x
mi-x
bi y
mi-y
bi z
mi-z
bi
]
[0055]
步骤十、建立运动平台做[x，y，z，α，β，γ]运动后，摆臂空间向量v
1i
，v
2i
；
[0056]v1i
＝[xi(1)-x
bi yi(1)-y
bi zi(1)-z
bi
]
[0057]v2i
＝[xi(2)-x
bi yi(2)-y
bi zi(2)-z
bi
]
[0058]
步骤十一、求解向量ui和向量v
1i
的夹角θ
1i
，求解向量ui和向量v
2i
的夹角θ
2i
：
[0059][0060][0061]
并，比较θ
1i
和θ
2i
，较小者为所求；
[0062]
步骤十二、比较计算
△i，
△i＝z
i-z
mi
，如果
△i为正，则驱动摆臂向上摆动；如果
△i为负，则驱动摆臂向下摆动。
[0063]
结合以上解算控制过程，我们设计摆臂连杆六自由度并联机器人，并确定其基座与运动平台的铰接点坐标如表1所示，摆臂末端点坐标如表2所示。
[0064]
表1平台铰接点初始坐标
[0065][0066]
表2
[0067][0068]
根据表1，运动平台做[10，10，10，2.5
°
，2.5
°
，2.5
°
]运动后，运动平台铰接点坐标在全局坐标系下的坐标(x
1i
，y
1i
，z
1i
)变换为如下表3所示。
[0069]
表3
[0070][0071][0072]
根据步骤四、步骤五、步骤六建立方程组：
[0073][0074][0075][0076]
[0077][0078][0079]
结合以上方程组，求解得到运动平台做[10，10，10，2.5
°
，2.5
°
，2.5
°
]运动后，摆臂末端坐标xi，yi，zi如，具体如表4所示。
[0080]
表4
[0081][0082][0083]
根据步骤九，建立零位摆臂空间向量如表5所示。
[0084]
表5
[0085]
u1[34.97，-60.63，0]u2[-34.67，60.01，0]u3[-70，0，0]u4[70，0，0]u5[34.67，60.01，0]u6[-34.97，-60.63，0]
[0086]
根据步骤十，建立运动平台做[x，y，z，α，β，γ]运动后，摆臂空间向量v
1i
，v
2i
如表 6所示。
[0087]
表6
[0088]v11
[34.47，-59.77，-11.80]v
21
[-27.76，48.03，42.69]v
12
[14.04，-24.36，64.11]v
22
[-34.47，59.67，12.29]v
13
[-69.78，0，5.57]v
23
[45.56，0，53.14]v
14
[64.26，0，27.76]v
24
[-12.59，0，68.86]v
15
[28.51，49.33，-40.67]v
25
[-33.25，-57.63，21.75]v
16
[31.22，54.01，31.75]v
26
[-30.14，-52.26，-35.51]
[0089]
根据步骤十一，求解向量ui和向量v
1i
的夹角θ
1i
，求解向量ui和向量v
2i
的夹角θ
2i
，
如表7所示。
[0090]
表7
[0091][0092]
根据步骤十一，经过比较比较θ
1i
和θ
2i
，得到所求摆臂末端坐标xi，yi，zi与摆臂运动夹角如表8所示。
[0093]
表8
[0094][0095]
根据步骤十二，比较计算
△i＝z
i-z
mi
，得到摆臂运动方向结果如表9所示。
[0096]
表9
[0097][0098]
接下来，我们以表9计算结果为输入量，机器人实验结果如图6、7所示，分别表示x， y，z方向移动行程以及α，β，γ转动角度的试验结果。结合图6、7所示，由图可知，x，y， z，α，β，γ运动的实际值分别为9.97mm，9.79mm，9.54mm，2.44
°
，2.45
°
，2.55
°
，结合表 9所示的运动控制结算结果，可见六个方向误差分别为0.03mm，0.21mm，0.46mm，0.06
°
， 0.05
°
，0.05
°
，误差范围在极小的控制范围内，本发明提出的摆臂连杆六自由度并联机器人的运动控制以及控制结算精度精确可靠，而且体积小、重量轻，可应用于诸如驾驶模拟、娱乐设备、游戏仿真、养生康复运动等多个方面，实现小型化、轻量化，并且控制精度稳定可靠。
[0099]
虽然本发明已以较佳实施例揭露如上，然其并非用以限定本发明。本发明所属技
术领域中具有通常知识者，在不脱离本发明的精神和范围内，当可作各种的更动与润饰。因此，本发明的保护范围当视权利要求书所界定者为准。