一种新型四轴载人离心机的运动学方法与流程

本发明涉及飞行训练领域，具体是一种新型四轴载人离心机的运动学方法。

背景技术：

四轴载人离心机是训练飞行员定向认知能力并且克服定向障碍的重要设备，基于离心运动平台的模拟器通过转臂的转动产生持续的过载，可在地面以较低的代价和更安全的方式对飞行员进行训练，提高飞行员在过载环境下的空间定向障碍防御。

典型的四轴载人离心机可实现主轴、偏航、滚转与俯仰四轴360°连续转动，可用于多种空间定向障碍飞行动作等训练。在结构设计上，其由外而内旋转顺序依次是主轴偏航运动、座舱偏航运动(z)、座舱滚转运动(x)、座舱俯仰运动(y),即zxy旋转配置模式。

针对典型四轴载人离心机的运动学逆问题，已分别实现“3个线加速度与实际飞行一致”(vladimirm.k.，2014)、“3个角运动与实际飞行一致”(茅坪，2019)的2种逆问题求解方法。三轴载人离心机可以在物理量上实现3个线加速度与实际飞行一致(vladimirm.k.，2014)。典型四轴载人离心机在运动学上仅能实现3个物理量与实际飞行一致。

技术实现要素：

本发明的目的在于克服现有技术的不足，提供一种新型四轴载人离心机的运动学方法，四轴载人离心机由外而内旋转顺序依次是主轴偏航运动、座舱滚转运动、座舱俯仰运动、座舱偏航运动，包括如下步骤：

步骤一：四轴载人离心机的主轴用于大臂转动从而产生离心加速度，大臂绕主轴的转动角度为q1，角速度为角加速度为滚转、俯仰、偏航3个旋转轴用于座舱的姿态调整，滚转轴与大臂末端相连，滚转轴的转动角度为q2，角速度为角加速度为俯仰轴在滚转框的内部，俯仰轴的转动角度为q3，角速度为角加速度为偏航轴在俯仰轴的内部，与座舱相连，偏航轴的转动角度为q4，角速度为角加速度为飞行员位于座舱内，飞行员头部位于3个姿态转动轴的中心，即飞行员的加速度与座舱的加速度一致；

步骤二：根据离心机各转轴的运动获取座舱中人体相对于座舱的运动，通过新型四轴载人离心机的运动学d-h参数；座舱相对于全局坐标系的旋转矩阵、线加速度、角加速度；得到座舱中人体相对于座舱的运动。

步骤三：根据飞行中飞行员承受的3个线加速度gxa、gya、gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线，反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线，使座舱中飞行员随体坐标系上的加速度与实际飞行一致。

进一步的，获得座舱相对于全局坐标系的旋转矩阵，末端执行器相对于全局的旋转矩阵为：

获得座舱的线加速度为：

式中：

gxc、gyc、gzc分别为沿x、y、z向的线加速度；r为主旋臂距旋转轴心的距离；g为重力加速度；

进一步的，获得座舱的角加速度，座舱的角加速度为：

在座舱坐标下的角加速度公式为：

式中：

⁴arotxc、⁴arotyc、⁴arotzc分别为在座舱坐标系下绕x、y、z轴的角加速度；

其中偏航角加速度公式为：

进一步的，所述的根据飞行中飞行员承受的3个线加速度gxa、gya、gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线，反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线，使座舱中飞行员随体坐标系上的加速度与实际飞行一致，包括如下过程：

获得主轴角运动，已知座舱随体坐标系上的线加速度gx、gy、gz，可计算得到座舱线加速度矢量的大小为：

在大臂末端产生的加速度矢量大小为：

获得姿态平台偏航运动，大臂末端的线加速度矢量：

偏航轴的角加速度：

将两次积分得到q4；

偏航轴q4求出后，对飞行数据进行坐标转换：

获得姿态平台滚运动，通过下式得到滚转轴的转动角度：

式中：

grv为线加速度矢量之和：

获得姿态平台俯仰运动；通过下式得到俯仰轴转动角度：

式中：³gxza为线加速度矢量之和：

本发明的有益效果是：本发明充分利用了四轴载人离心机多了偏航轴的优势，可以在运动学逆问题求解上实现4个物理量与实际飞行一致，从而降低了四轴载人离心机的控制难度，提高了其在飞行训练方面的应用前景。

附图说明

图1为一种新型四轴载人离心机的运动学方法的流程图；

图2为空间定向障碍模拟器gz数据修正示意图。

具体实施方式

下面结合附图进一步详细描述本发明的技术方案，但本发明的保护范围不局限于以下所述。

如图1所示，本发明，所提供的一种新型四轴载人离心机的运动学方法包括，步骤一，新型四轴载人离心机的主轴用于大臂转动从而产生离心加速度，定义大臂绕主轴的转动角度为q1，角速度为角加速度为滚转、俯仰、偏航3个旋转轴用于座舱的姿态调整，滚转轴与大臂末端相连，定义滚转轴的转动角度为q2，角速度为角加速度为俯仰轴在滚转框的内部，定义俯仰轴轴的转动角度为q3，角速度为角加速度为偏航轴在俯仰轴的内部，与座舱相连，定义偏航轴的转动角度为q4，角速度为角加速度为飞行员位于座舱内，飞行员头部位于3个姿态转动轴的中心，即飞行员的加速度与座舱的加速度一致。

步骤二：运动学正问题计算。即根据离心机各转轴的运动获取座舱中人体相对于座舱的运动。

(2.1)获取新型四轴载人离心机的运动学d-h法参数。新型四轴载人离心机的运动学d-h法参数如表1所示。

表1四轴载人离心机的d-h参数表

(2.2)获得座舱相对于全局坐标系的旋转矩阵。末端执行器(座舱)相对于全局的旋转矩阵为：

(2.3)获得座舱的线加速度。可计算得到座舱的线加速度(座舱坐标系)为：

式中：

gxc、gyc、gzc—沿x、y、z向的线加速度；

r—主旋臂距旋转轴心的距离；

g—重力加速度。

(2.4)获得座舱的角加速度。座舱的角加速度(全局坐标系)为：

在座舱坐标下的角加速度公式为：

式中：

⁴arotxc、⁴arotyc、⁴arotzc—分别为在座舱坐标系下绕x、y、z轴的角加速度；

其中偏航角加速度公式为：

步骤三：运动学逆问题计算。四轴载人离心机的运动学逆问题求解，即已知实际飞行中飞行员承受的3个线加速度gxa、gya、gza和3个角加速度arotxc、arotyc、arotzc随时间变化曲线，希望座舱中飞行员随体坐标系上的加速度与实际飞行一致，反求4个转轴的旋转角度q1、q2、q3、q4随时间变化曲线。座舱中飞行员要满足的加速度包括3个线加速度和3个角加速度共6个自由度，而可控制的转轴自由度只有q1、q2、q3、q4共4个自由度，因此无法同时满足离心机座舱中飞行员6个自由度的加速度与实际飞行一致，通常根据飞行模拟需要，使得部分自由度加速度与实际飞行一致。

新型四轴载人离心机可以实现4个物理量与实际飞行一致，即要求3个线加速度、以及偏航角加速度与实际飞行一致。比原来的四轴载人机多实现了偏航角加速度与实际飞行一致。

四轴载人离心机4个转轴，只有主轴的角运动才影响线加速度矢量的大小，因此可根据实际飞行线加速度矢量的大小，首先确定主轴的角运动。

(3.1)初步获得主轴角运动。已知座舱随体坐标系上的线加速度gx、gy、gz，可计算得到座舱线加速度矢量的大小为：

在实际飞行中存在失重(|ga|值小于1g，1g即1个重力加速度)现象，而在地面上由于重力的作用，空间定向障碍模拟器产生的g值必定大于1g，因此需要对|ga|值进行处理，通常采用如图2所示的1.4g基础g水平的方式修正gz数据。

由于主轴转动，在大臂末端产生的加速度矢量大小为：

让主悬臂转动，末端加速度矢量大小与座舱线加速度矢量大小一致，通过常微分方程求解，可获得主轴的转动角速度和转动角加速度

(3.2)获得姿态平台偏航运动。主轴的角运动求解完成后，即可得到大臂末端的线加速度矢量：

主轴的角运动求解完成之后，首先在偏航角加速度物理量上实现与实际飞行一致，再调整滚转轴和俯仰轴实现3个线加速度物理量的一致性。

根据公式(5)，可以得到偏航轴的角加速度：

将两次积分得到q4。

偏航轴q4求出后，不能直接求解滚转轴q2和俯仰轴q3的角度，需要对飞行数据进行坐标转换：

(3.3)获得姿态平台滚运动。通过下式可计算得到滚转轴的转动角度：

式中：

grv—线加速度矢量之和：

(3.4)获得姿态平台俯仰运动。通过下式可计算得到俯仰轴转动角度：

式中：

³gxza—线加速度矢量之和：

以上所述仅是本发明的优选实施方式，应当理解本发明并非局限于本文所披露的形式，不应看作是对其他实施例的排除，而可用于各种其他组合、修改和环境，并能够在本文所述构想范围内，通过上述教导或相关领域的技术或知识进行改动。而本领域人员所进行的改动和变化不脱离本发明的精神和范围，则都应在本发明所附权利要求的保护范围内。