专利名称：高速列车自主导航及姿态测量装置的制作方法
技术领域：
本发明涉及一种
背景技术：
目前，载体姿态测量方法繁多、涉及到的领域广泛。a)倾角传感器采用一个三轴加速度计(三个单轴加速度计)敏感重力分量测得姿态角信息，倾角传感器姿态测量具有成本低、结构简单的优点，但是，其动态性能和温度性能差。b)微型方位水平仪利用微机电系统(MEMS)技术,设计了由微机电传感器组合而成的微型方位水平仪，该系统由三轴微加速度计和三轴微磁强计组成，利用大地磁场和重 力场在地理坐标系和载体坐标系的方向余弦进行解算得到姿态角，该微型姿态测量系统具有体积小、重量轻功耗低启动快等优点，但其精度较差。c)导航卫星技术姿态测量在载体平台上适当配置两个以上非共线卫星天线，利用载波相位差分测量技术，即利用多个天线接收的载波相位差、测距码和导航电子信息，通过一定算法解算天线之间确定的基线向量，从而得到载体姿态，该方法精度较高，但其可靠性和稳定性较差。d)其他还有采用光电测量技术测量姿态，如基于干涉技术的多自由度测量方法、基于衍射技术的多自由度测量方法、多CCD的视觉测量技术等，结构复杂、检测过程繁琐、动态性能较差，不易工程化。
发明内容
为了克服现有技术的缺点，本发明提供一种高速列车自主导航及姿态测量装置，它结构简单，稳定性好，精度高。本发明解决其技术问题所采取的技术方案是它包括三轴光纤陀螺、三轴加速度计、导航计算机、温控电路板、功放电路板和电源�？椋峁庀送勇莺腿峒铀俣燃乒塘谠靥迳希虼私萘叩枷低趁挥薪峁蛊教ㄎ铀俣燃铺峁┎饬勘攘Φ幕迹遣捎眉词毙拚萘卣笞魑捌教ā保ü己郊扑慊杉庀送勇莺图铀俣燃剖涑龅脑靥遄晗�(坐标原点Ob在高速列车重心处,Xb沿高速列车的纵轴指向前、yb高速列车横轴指向右)线加速度和角速度信息，通过坐标变换和捷联矩阵、速度、位置矩阵的即时修正单值地确定载体的姿态角信息、速度和位置信息。本发明可以很高的速率和精度以数字形式提供载体姿态信息，可以与GPS组合输出精度较高的定位信息(经度λ、纬度免)，在GPS信号受到干扰的时候还可以在纯惯导状态下进行定位。具有结构简单、稳定性好、精度高的优点。
下面结合附图和实施例对本发明进一步说明。
图1为本发明捷联惯导系统原理框图；图2为本发明平台坐标系与地球坐标系关系示意图。
具体实施例方式如附图所示，它包括三轴光纤陀螺、三轴加速度计、导航计算机、温控电路板、功放电路板和电源�？椋峁庀送勇莺腿峒铀俣燃乒塘谠靥迳希虼私萘叩枷低趁挥薪峁蛊教ㄎ铀俣燃铺峁┎饬勘攘Φ幕迹遣捎眉词毙拚萘卣笞魑捌教ā保ü己郊扑慊杉庀送勇莺图铀俣燃剖涑龅脑靥遄晗�(坐标原点Ob在高速列车重心处，xb沿高速列车的纵轴指向前、yb高速列车横轴指向右)线加速度和角速度信息，通过坐标变换和捷联矩阵、速度、位置矩阵的即时修正单值地确定载体的姿态角信息、速度和位置信息。工作原理 1、姿态解算由于捷联惯导系统没有机械平台，因而捷联矩阵起到了平台的作用，又叫做“数学平台”。由于捷联矩阵能够单值的确定载体姿态角，因此又叫做姿态矩阵。要对高速列车的姿态信息的实时测量，需要通对姿态矩阵的即时修正。本系统采用四元数法(四参数法)对姿态矩阵进行实时修正。设高速列车坐标系相对平台坐标系的转动可用转动四元数Q = q0+q1i+q2j+q3k表示。其中1、j、k与高速列车坐标系的基一致。利用四元数微分方程表示四元数的即时修正，即
权利要求
1.一种高速列车自主导航及姿态测量装置，其特征在于它包括三轴光纤陀螺、三轴加速度计、导航计算机、温控电路板、功放电路板和电源�？椋峁庀送勇莺腿峒铀俣燃乒塘谠靥迳希虼私萘叩枷低趁挥薪峁蛊教ㄎ铀俣燃铺峁┎饬勘攘Φ幕迹遣捎眉词毙拚萘卣笞魑捌教ā保ü己郊扑慊杉庀送勇莺图铀俣燃剖涑龅脑靥遄晗迪呒铀俣群徒撬俣刃畔ⅲü瓯浠缓徒萘卣�、速度、位置矩阵的即时修正单值地确定载体的姿态角信息、速度和位置信息。
全文摘要
本发明涉及一种高速列车自主导航及姿态测量装置。它包括三轴光纤陀螺、三轴加速度计、导航计算机、温控电路板、功放电路板和电源�？椋峁庀送勇莺腿峒铀俣燃乒塘谠靥迳希虼私萘叩枷低趁挥薪峁蛊教ㄎ铀俣燃铺峁┎饬勘攘Φ幕迹遣捎眉词毙拚萘卣笞魑捌教ā保ü己郊扑慊杉庀送勇莺图铀俣燃剖涑龅脑靥遄晗迪呒铀俣群徒撬俣刃畔ⅲü瓯浠缓徒萘卣�、速度、位置矩阵的即时修正单值地确定载体的姿态角信息、速度和位置信息。它结构简单，稳定性好，精度高。
文档编号G01C21/16GK103017764SQ20121052405
公开日2013年4月3日 申请日期2012年12月7日 优先权日2012年12月7日
发明者井世丽, 刘炳臣 申请人:河北汉光重工有限责任公司
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
