一种基于姿态跟踪的月面虚拟驾驶体感反馈方法

[0018][0019]
其中，f1，f2分别为人体坐标系、惯性坐标系中的比力。ω1，分别为人体坐标系，惯性坐标系中的角速度信号。ls为人体坐标系变换到惯性坐标系的坐标变换矩阵，ts为角速度转换为欧拉角变化率的变换矩阵。
[0020]
步骤(3)：通过三阶线加速度高通滤波器对惯性坐标系中的线加速度进行高通滤波，保证平台在模拟任务完成后尽快回到初始位置。高通滤波器的传递函数如下：
[0021][0022]
其中，a2为输入线加速度，为滤波后的加速度，s为复参数，ωm、ωh为一阶、二阶环节的自然截止频率，ξh为三阶高通滤波器的阻尼比，取ξh＝1。
[0023]
步骤(4)：设计倾斜协调环节中二阶低通滤波器，二阶低通滤波器的传递函数如下：
[0024][0025]
其中，f1为人体坐标系中的比力，作为二阶低通滤波器输入，f
low
为低通滤波器输出量。ω
l
为二阶低通滤波器的自然截止频率，ξ
l
为二阶低通滤波器的阻尼比，取1。
[0026]
步骤(5)：月球车行驶过程中，各方向的姿态角变化差异较大，其中偏航角的变化范围大。对俯仰角、滚转角采用一阶滤波器滤波，偏航角采用二阶滤波器滤波。
[0027]
一阶高通滤波器与低通滤波器的传递函数分别为：
[0028][0029][0030]
其中，为惯性坐标系的角速度信号，作为滤波器输入，为一阶高通滤波器与低通滤波器的输出量，ω
hβ
与ω
lβ
分别为高通滤波器与低通滤波器的自然截止频率，取1(rad/s)。
[0031]
二阶高通滤波器与低通滤波器的传递函数分别为：
[0032][0033][0034]
其中，为二阶滤波器输入量，分别为二阶高通、低通滤波器输出量，ω
hθ
与ω
lθ
为高通滤波器与低通滤波器的自然截止频率，ξ
hθ
与ξ
lθ
分别为二阶高通滤波器与低通滤波器的阻尼比，取1。
[0035]
步骤(6)：通过滤波器得到各分量后，倾斜协调环节将低频线加速度分量转化为倾斜角度，公式如下：
[0036][0037][0038]
其中，为纵向和横向的比例输入的低频分量，为倾斜协调的俯仰角和滚转角。
[0039]
步骤(7)：将各分量通过限幅和积分环节并叠加，得到三自由度的线位移量与三自由度的角位移量用于控制六自由度平台运动。
[0040]
与现有技术相比，本发明的优点和积极效果在于：
[0041]
本方案研究月球车驾驶模拟器体感反馈方法，考虑到月面驾驶时，月球车的速度较低，位姿改变较小，六自由度运动平台对其线加速度的高频分量与角速度容易跟踪。从算法整体结构出发，优化体感反馈技术。体感反馈方法采用跟踪高频线加速度，利用倾斜协调模拟纵向与横向线加速度，并通过角速度限幅环节确保人体难以感知到倾斜协调引起的位姿改变。而对于角速度，对低频角速度造成的平台角位移做出限制，保证六自由度平台机械结构能够完成低频角速度、高频角速度、倾斜协调三个分量影响下的角位移任务。有效提高月球车驾驶模拟的运动逼真度，提升驾驶训练效果。
附图说明
[0042]
图1为本发明实施例所述体感反馈方法原理框图；
[0043]
图2为本发明实施例中所述控制算法原理框图；
[0044]
图3为加速度经过控制算法滤波后的曲线图；
[0045]
图4为角速度经过控制算法滤波后的曲线图。
具体实施方式
[0046]
下面结合附图和具体实施方式，进一步阐明本发明，应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
[0047]
一种基于姿态跟踪的月面虚拟驾驶体感反馈方法，主要应用于月球车驾驶模拟器中，如图1所示，为其原理示意图，主要包括：
[0048]
步骤1、月面驾驶模拟器控制系统初始化，确定运动平台位于初始位置。
[0049]
步骤2、设定月球车动力学模型，获得相应运动参数。
[0050]
进一步的，所述月球车运动参数包括机体坐标系下的滚转角速度、俯仰角速度、偏航角速度。
[0051]
步骤3、以六自由度模拟器为例，构建控制算法模型。算法由平移通道(纵向、横向、垂向)和旋转通道(横滚、俯仰、偏航)组成。将步骤2得到的月球车运动参数以及耳石感知的线加速度作为控制算法模型的输入，获得位移和姿态角信息。具体的，控制算法实现流程如图2所示：
[0052]
(1)将耳石感知的线加速度以比力f
aa
的形式表示：
[0053]faa
＝a-g
[0054]
其中，a为人体绝对线加速度，g为重力加速度。
[0055]
(2)：将人体坐标系中的线加速度和角速度转换为惯性坐标系中的线加速度和角速度。
[0056]
f2＝lsf1[0057][0058]
其中，f1，f2分别为人体坐标系、惯性坐标系中的比力。ω1，分别为人体坐标系，惯性坐标系中的角速度信号。ls为人体坐标系变换到惯性坐标系的坐标变换矩阵，ts为角速度转换为欧拉角变化率的变换矩阵。
[0059]
(3)增加低截止频率的一阶环节，通过三阶线加速度高通滤波器对惯性坐标系中的线加速度进行高通滤波，保证平台在模拟任务完成后尽快回到初始位置。传递函数如下：
[0060][0061]
其中，a2为输入线加速度，为滤波后的加速度，s为复参数，ωm、ωh为一阶、二阶环节的自然截止频率，ξh为三阶高通滤波器的阻尼比，取ξh＝1。
[0062]
(4)设计倾斜协调环节中二阶低通滤波器，二阶低通滤波器的传递函数如下：
[0063][0064]
其中，f1为人体坐标系中的比力，作为二阶低通滤波器输入，f
low
为低通滤波器输出量。ω
l
为二阶低通滤波器的自然截止频率，ξ
l
为二阶低通滤波器的阻尼比，取1。
[0065]
(5)对于角度变化，月球车驾驶模拟器在运行的过程中三个方向的旋转角度的模式不同。其中，俯仰和滚转角变化范围小、角速度相对较小，采用一阶滤波器。一阶高通滤波器与低通滤波器传递函数分别为：
[0066][0067][0068]
其中，为惯性坐标系中的角速度信号，作为滤波器输入，为一阶高通滤波器与低通滤波器的输出量，ω
hβ
与ω
lβ
分别为高通滤波器与低通滤波器的自然截止频率，取1(rad/s)；
[0069]
月球车偏航角与驾驶时的转向有关，运动范围及不确定性较大，采用二阶高通滤波器滤波，侧向和纵向的协调倾斜通道采用二阶低通滤波器。二阶高通滤波器和低通滤波器的传递函数如下：
[0070][0071][0072]
其中，为滤波器输入量，分别为二阶高通、低通滤波器输出量，
ω
hθ
与ω
lθ
为高通滤波器与低通滤波器的自然截止频率，ξ
hθ
与ξ
lθ
分别为二阶高通滤波器和低通滤波器的阻尼比，取1。
[0073]
(6)通过滤波器得到各分量后，将低频线加速度分量转化为倾斜角度，在协调通道中增加协调变换环节，公式如下：
[0074][0075][0076]
其中，为纵向和横向的比例输入的低频分量，为倾斜协调的俯仰角和滚转角。
[0077]
(7)将各分量通过限幅和积分环节并叠加，得到三自由度的线位移量与三自由度的角位移量用于控制六自由度平台运动。
[0078]
步骤4、基于步骤3所获得的位移和姿态角信息，通过运动学反解对运动平台进行速度、加速度以及动力学分析，进而得到各液压缸伸长量，驱动运动平台运动。
[0079]
图3，图4分别为加速度和角速度经过控制算法处理后的曲线图。可以看出，改进的六自由度平台控制算法能将平台的运动限制在安全范围内，并还原加速度、角速度变化趋势，实现了车体的六自由度姿态跟踪。
[0080]
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段，还包括由以上技术特征任意组合所组成的技术方案。