防晕稳定机构的制作方法
【专利说明】
一、技术领域
[0001]本发明属于工业自动化控制技术领域，尤其涉及一种高性能防晕稳定机构，适于车、船等交通工具的普及应用，避免或消除晕车、晕船等不适情况的发生。
二、【背景技术】
[0002]现有各类交通工具上的座椅多是刚性连接，因此，当交通工具存在剧烈颠簸或晃动时，乘客会发生晕车、晕船等严重不适反应。查询现有专利、论文等公开技术文献涉及的防晕设备，结构复杂，不具有通用性，且生产成本高，应用范围受限。
三、
【发明内容】
[0003]为解决上述问题，本发明提供一种基于现代测控技术的机电一体化防晕稳定机构，具有测控精确、结构易于实现、通用性强、且具有良好市场前景的防晕稳定机构。
[0004]本发明的技术方案为:将防晕稳定机构固定于交通工具和设施(如床、座椅等)之间；所述的防晕稳定机构包括:上平台、双自由度关节一、双自由度关节二、双自由度关节三、作动器一、作动器二、作动器三、机构控制器、单自由度关节一、单自由度关节二、单自由度关节三和下平台；其特征在于:下平台与交通工具固联，机构控制器固定在下平台的任意位置，用于感知下平台的空间姿态角变化，作动器一、作动器二、作动器三的基座分别通过单自由度关节一、单自由度关节二、单自由度关节三固定在下平台上，作动器一、作动器二、作动器三的另一端分别通过双自由度关节一、双自由度关节二、双自由度关节三设施固定在上平台上，机构控制器根据姿态角控制作动器一、作动器二、作动器三，通过实时改变作动器的推杆长度，使上平台的空间姿态始终平衡稳定。
[0005]所述单自由度关节一、单自由度关节二、单自由度关节三绕下平台的几何中心呈等距离均匀圆周分布，并固定在下平台上。
[0006]所述双自由度关节一、双自由度关节二、双自由度关节三绕上平台的几何中心呈等距离均匀圆周分布，并固定在上平台上。
[0007]所述作动器一、作动器二、作动器三的功能及参数完全相同，对振动和位移具有快速响应和实时调整能力，每个作动器的构成包括:电机、传动机构、丝杠、推杆、位置传感器、限位开关和基座，其工作原理为:电机固定在基座上，传动机构将电机力矩输出到丝杠上，丝杠带动推杆完成直线往复运动，位置传感器与丝杠同轴联结，用于检测推杆的位移量，并转换为控制电机的电参量反馈信号，由位置传感器反馈推杆的实时长度，限位开关固定在基座上，用于检测作动器的推杆的极点位置信息，反馈到位指示信号。
[0008]所述的机构控制器包括中央控制器、惯性敏感元件、温度传感器、信号调理单元、通信接口单元、电机驱动器及电源变换单元，惯性敏感元件监测机座的振动及位移，并转换为电参量送至信号调理单元，已调理信号输出至中央控制器采集、处理后，发出控制三个作动器的推杆长度变化指令，并与作动器一、作动器二、作动器三的推杆位移反馈量进行比较，形成三个作动器的电机驱动指令，通信接口单元实现与上位机的数据通信，温度传感器精密补偿惯性敏感元件的检测精度，电源变换单元提供整机的动力电源和控制电源。
[0009]中央控制器选择嵌入式MCU、FPGA或SOC的任意类型，惯性敏感元件为加速度传感器、陀螺仪的任意类型，或两种类型的组合应用，温度传感器为模拟温度传感器和数字温度传感器的任意类型，信号调理单元为模拟接口电路和数字接口电路的多种电路形式，通信接口单元为485、CAN、RF、ZigBee任意类型的功能模块，驱动器为直流驱动器和交流驱动器，电源变换单元为AC-DC或DC-DC等拓扑结构。
[0010]所述中央控制器是本发明的控制核心，利用惯性敏感元件监测下平台的姿态变化，利用温度传感器对惯性敏感元件精密补偿，通过信号调理、数据融合算法、坐标变换和编程设计，转换为控制三个作动器的推杆长度变化指令，并与作动器一、作动器二、作动器三的推杆位移反馈量进行比较，形成三个作动器的电机驱动指令，实现上平台的平衡稳定。
[0011]具体工作过程为:惯性敏感元件监测下基座的姿态变化，通过参量变换、信号调理和接口单元，传送至中央控制器并进行数据比较、处理，实时控制三个驱动电机。过程控制如下:惯性敏感元件，如三轴加速度传感器、双轴陀螺仪和温度补偿传感器的输出作为二阶闭环系统的反馈信号。通过对双轴陀螺仪的速度信号进行积分，可得到下平台的粗精度空间姿态角，对三轴加速度传感器的输出信号解算可得到下平台的高精度姿态角，通过对三轴加速度计的输出信号解算可得到的下平台的高精度空间姿态角，用高精度空间姿态角定时修正低精度空间姿态角值，并结合温度反馈进行温度补偿，即可得到高实时性高精度的下平台空间姿态角，对该姿态角进行坐标变换可以得到三个作动器推杆的实时长度指令，再通过位置闭环算法控制三个电机驱动器带动电机改变作动器的推杆长度，实现上平台的空间平衡稳定，通讯接口用于接收外部指令并向外输出机构的运行状态。
[0012]本发明与现有技术比较，具有如下特点:
[0013](I)基于现代测控原理的数字控制机电一体化稳定机构，具有技术先进、测控精度尚的明显特点。
[0014](2)适于车、船防晕座椅、防晕床等多种用途。
[0015](3)结构简化，轮廓较低，易于生产和安装。
[0016](4)生产成本较低，具有较强的市场竞争力，应用前景广阔。
四、【附图说明】
[0017]图1是防晕稳定机构的结构示意图；
[0018]图2是作动器的组成框图；
[0019]图3是机构控制器的组成框图；
[0020]图4三轴加速度信号调理应用电路实例；
[0021]图5陀螺仪信号调理及接口电路应用电路实例；
[0022]图6基于32位嵌入式微处理器的键盘显示多机操控应用电路实例；
[0023]图7基于32位嵌入式微处理器的单机执行机构控制电路应用实例。
五、【具体实施方式】
[0024]下面结合附图对本发明进行详细说明:参见图1一图3:—种防晕稳定机构，包括上平台1、双自由度关节一 2、双自由度关节二 3、双自由度关节三4、作动器一 5、作动器二 6、作动器三7、机构控制器9、单自由度关节一、10、单自由度关节二11、单自由度关节三12和下平台8;其特征在于:下平台8与交通工具固联，机构控制器9固定在下平台8上，作动器一 5、作动器二6、作动器三7的基座分别通过单自由度关节一、10、单自由度关节二 11、单自由度关节三12固定在下平台8上，作动器一5、作动器二6、作动器三7的另一端分别通过双自由度关节一2、双自由度关节二3、双自由度关节三4设施固定在上平台I上，机构控制器9固定在下平台8的任意位置，用于感知下平台8的空间姿态角变化，根据姿态角控制作动器一 5、作动器二 6、作动器三7，通过实时改变作动器一 5、作动器二 6、作动器三7的推杆长度，使上平台I的空间姿态始终平衡稳定。
[0025]自由度关节一2、双自由度关节二3、双自由度关节三4绕上平台I的几何中心呈等距离均匀圆周分布，并固定在上平台I上。
[0026]单自由度关节一、10、单自由度关节二丨丨、单自由度关节三12绕下平台8的几何中心呈等距离均匀圆周分布，并固定在下平台8上。
[0027]作动器一、作动器二 6、作动器三7的构成分别包括电机、传动机构、丝杠、推杆、位置传感器、限位开关和基座，且3个作动器的功能及参数完全相同。
[0028]电机固定在基座上，传动机构将电机力矩输出到丝杠上，丝杠带动推杆完成直线往复运动，位置传感器与丝杠同轴联结，用于检测作动器的推杆位移量，并转换为控制电机的电参量反馈信号，限位开关固定在基座上，用于检测作动器的推杆极点位置信息。
[0029]机构控制器包括中央控制器、惯性敏感元件、温度传感器、信号调理单元、通信接口单元、电机驱动器及电源变换单元，惯性敏感元件监测机座的振动及位移，并转换为电参量送至信号调理单元，已调理信号输出至中央控制器采集、处理后，发出驱动电机的控制指令，电机驱动器带动作动器的推杆动作；中央控制器同时接收作动器的推杆的位置反馈信号，感知推杆当前的位移并实时控制;通信接口单元实现与上位机的数据通信，温度传感器精密补偿惯性敏感元件的检测精度，电源变换单元提供整机的动力电源和控制电源。
[0030]所述机构控制器的特征在于，中央控制器选择嵌入式M⑶、FPGA或SOC的任意类型，惯性敏感元件为加速度传感器、两自由度陀螺仪的任意类型，或两种类型的组合应用，温度传感器为模拟温度传感器和数字温度传感器的任意类型，信号调理单元为模拟接口电路和数字接口电路，或其组合电路形式，通信接口单元为通用功能模块(如485、CAN总线)或专用功能模块(如RF、ZigBee)，驱动器为直流驱动器和交流驱动器，电源变换单元包括AC-DC或DC-DC等拓扑结构。
[0031]所述中央控制器是本发明的控制核心，利用惯性敏感元件监测下平台的姿态变化，利用温度传感器对惯性敏感元件精密补偿，通过信号调理、数据融合算法、坐标变换和编程设计，转换为控制三个作动器的推杆长度变化指令，并与作动器的推杆位移反馈量进行比较，形成三个作动器的电机驱动