Stewart平台姿态测量装置的制造方法
【技术领域】
[0001]本实用新型涉及一种Stewart平台姿态测量装置，尤其涉及一种采用全加速度传感器实现六自由度Stewart平台形心位置、旋转角度和旋转方向的姿态参数测量的测量装置，属于运动模拟器姿态测量领域。
【背景技术】
[0002]Stewart平台又称为并联平台机构，它是由动平台、静平台、铰链和六个驱动杆组成，可以实现6个自由度的转动。由于这种机构具有结构简单、动态性能好、刚度大、承载能力强等优点，在机器人、机床制造行业、汽车运动模拟器、航天运载工具模拟器、空间对接机构、潜艇救援对接器及高速铁路无砟轨道板等方面具有极高的应用价值。
[0003]Stewart平台的位置姿态控制精度是衡量其工作质量优劣和性能高低的主要指标，成为并联驱动平台应用研宄中的关键技术之一，平台控制算法的核心内容是位置正解和位置反解，即已知动平台位姿求解驱动杆长(反解)，或已知各驱动杆长求解动平台位姿(正解)。测量出动平台位置姿态六参数(x，y，z，α, β, γ)τ，即可求解反解；相反已知杆长变化可正解出位姿6参数。一般来说正解多采用数值分析法，比如牛顿一辛卜森法迭代求解计算量大、速度慢、不能闭环控制，相比之下反解速度快可实现实时控制。
[0004]目前对平台位置和姿态的精确控制常用方法主要有两种。一是机电法，通过测量电机的角位移或油缸的伸缩线位移进行反馈控制，该方案的优点是成本低，便于实现，缺点是半闭环控制，精度低；二是光电法，通过单个或两个摄像头获取三维定位信息，其优点是精度高，但是造价高，可定位范围小，对应用现场也有较高要求。这两种方法都具有较强的局限性，由于位置和姿态的精确控制是并联平台机构得以实现其应用价值的必要前提，因而对其进行高精度的动态位姿测量就具有十分重要的意义，基于实时控制的强烈需求，本实用新型提出一种基于无陀螺捷联惯导系统测量装置，采用4只三轴加速度传感器直接测量Stewart平台位姿参数的新装置。
[0005]无陀螺捷联惯导是指惯性测量组合中不使用陀螺仪，而利用线加速度计得到惯性测量的全部参数，适用于战术导弹、智能炮弹中等利用加速度计代替陀螺实现制导的领域。此理念国外早在1965年就提出，但此后近20年时间里一直停顿，主要原因是陀螺技术的飞速发展。进入20世纪90年代，随着计算机技术以及MEMS水平的提高，中国国内外对采用全加速度计制作惯性测量的研宄方案越来越重视，使其重获新生。1982年Shmuel J.Merhav提出采用旋转或振动加速度计组成无陀螺惯性测量组件，提出从加速度计的输出信号中分离线加速度和角速度的方法；1991年Algrain断言最少需要六个加速度计可测量物体的线加速度和角加速度；1999年Lee求出了利用6个加速度计测量物体旋转运动的解法，并将卡尔曼滤波应用在导航系统中；2000年Kirill详细研宄了基于六加速度计配置的算法。国内的研宄刚刚起步，主要进行此方向研宄的有哈尔滨工程大学、哈尔滨工业大学、北京理工大学等少数高校，但目前研宄内容主要涉及到不同应用领域加速度计配置方案的研宄，及相应角速度的优化算法等，还没有具体应用方面的报道。通过调研，国内外学者在无陀螺捷联惯导加速度计方案配置方面，主要采用的是六加速度配置方案，细分又有好几种，但都是由加速度计输出的比力中解出载体角加速度，再经积分得到角速度。主要缺点有些是由于角速度项由平方根计算得到，无法确定角速度方向；或者计算量大，且角速度的误差随时间累积，或者对安装的精度要求太高，实际应用困难，由于以上原因六加速度计方式不是很理想的方式。九加速度计配置方案是一种改进方式，利用加速度计输出的冗余信息改进角速度解算算法从而提高精度，通过对角加速度积分确定角速度符号消除角速度符号的不确定性，对角速度平方项开方确定数值抑制迭代误差，但具体算法为见公布，且从文献上看传感器的安装位置配置不适合应用于Stewart这类动平台上。
【实用新型内容】
[0006]本实用新型的目的就在于为了解决上述问题而提供一种采用全加速度传感器实现Stewart平台姿态测量装置。
[0007]本实用新型通过以下技术方案来实现上述目的:
[0008]—种Stewart平台姿态测量装置，所述Stewart平台包括动平台和静平台，所述动平台和所述静平台之间通过六个球铰分别与六根可伸缩的连杆相连；设动平台坐标系1J的三个坐标轴轴向分别为X、Y、Z，其坐标原点Ob是所述动平台的6个球铰的机械绞点组成的圆周的圆心，设静平台坐标系11I的坐标原点仏是所述静平台的6个球铰的机械绞点组成的圆周的圆心；在所述动平台上安装有四个垫块，在四个所述垫块上一一对应地安装有四个三轴向加速度传感器，其中，所述第一三轴向加速度传感器和所述第四三轴向加速度传感器分别安装于对应的所述垫块的上表面，所述第二三轴向加速度传感器和所述第三三轴向加速度传感器分别安装于对应的所述垫块的侧表面；四个所述三轴向加速度传感器的三个敏感轴方向均为X、1、z，其中，第一三轴向加速度传感器与第四三轴向加速度传感器以坐标原点Ob对称并分别位于X轴的两侧，第二三轴向加速度传感器与第三三轴向加速度传感器以X轴为对称轴对称安装，所述第一三轴向加速度传感器的X、1、z轴分别与所述动平台的X、Y、Z轴平行，所述第一三轴向加速度传感器、所述第二三轴向加速度传感器、所述第三三轴向加速度传感器、所述第四三轴向加速度传感器的包含安装方向的坐标分别为:
(Xl、—yI N Z1)、(_x2、y2、Z2)、(_叉2、_^2、Z2)、(_Xl、Yi ' Z1) O
[0009]具体地，所述三轴向加速度传感器为灵敏度为lOOmv/g、量程为50g、精度为0.0OOlg、频响范围为0.5-4.5kHz的低频三轴向加速度传感器。
[0010]本实用新型的有益效果在于:
[0011]本实用新型通过在动平台上配置四个三轴向加速度传感器，并对其两两对称安装，在能够测量Stewart平台姿态的前提下，大大简化了测量装置的结构，既便于安装，又便于测量Stewart平台姿态。
【附图说明】
[0012]图1是本实用新型所述Stewart平台姿态测量装置的结构示意图；
[0013]图2是本实用新型所述第一三轴向加速度传感器和第一垫块的立体结构示意图。
【具体实施方式】
[0014]下面结合附图对本实用新型作进一