机动车辆姿态的测量方法及测量装置制造方法及图纸

本发明专利技术涉及机动车辆姿态的测量方法及测量装置，该方法包括如下步骤：通过卫星定位模块获取车辆的航向角和瞬时速度以得到地理坐标系上的加速度；根据地理坐标上的加速度换算得到载体水平坐标系上的加速度；根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的比力，并求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态；根据公式Q＝Pi‑1·D求取输出姿态，其中，Q为陀螺仪积分出的姿态，D为角速度乘以时间间隔构造的微旋转，Pi为当前输出姿态；将理论姿态和输出姿态进行插值处理，并将输出姿态以四元数的形式输出。本发明专利技术将卫星定位、加速度计和陀螺仪结合在一起作为倾角传感器，使得输出准确的倾角。

【技术实现步骤摘要】
【专利摘要】本专利技术涉及机动车辆姿态的测量方法及测量装置，该方法包括如下步骤：通过卫星定位模块获取车辆的航向角和瞬时速度以得到地理坐标系上的加速度；根据地理坐标上的加速度换算得到载体水平坐标系上的加速度；根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的比力，并求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态；根据公式Q＝Pi?1·D求取输出姿态，其中，Q为陀螺仪积分出的姿态，D为角速度乘以时间间隔构造的微旋转，Pi为当前输出姿态；将理论姿态和输出姿态进行插值处理，并将输出姿态以四元数的形式输出。本专利技术将卫星定位、加速度计和陀螺仪结合在一起作为倾角传感器，使得输出准确的倾角。【专利说明】机动车辆姿态的测量方法及测量装置
本专利技术设及机动车机动自动检测技术，尤其设及机动车辆姿态测量的方法及测量 装置。
技术介绍
驾驶人在取得机动车驾驶证前，需要通过场地驾驶技能和道路驾驶技能的考试， 即俗称的"科目二考试"和"科目Ξ考试"；前者用于考核驾驶人在常见道路、常见交通环境、 常见气候条件和突发交通状况下对机动车的操控能力，W及对交通事件的处理能力；后者 用于考核驾驶人在实际道路驾驶机动车时对机动车的操控能力、对交通法规的识别和遵守 能力、对道路交通情况的处理能力、W及文明驾驶、安全驾驶的意识。 在科目二和科目Ξ考试中已经使用基于卫星定位系统的解决方案。为了判断车辆 行驶是否符合考试规则，需要获得车辆的位置和姿态。双天线卫星定位可W提供位置、航向 角和俯仰角，而横滚角需要额外的倾角传感器。倾角传感器的物理原理是用加速度计测量 比力，当设备静止时，倾角与比力相关。但是考试过程中车辆是变速运动的，比力包含运动 加速度，运时单独使用倾角传感器测出来的倾角并不准确。
技术实现思路
针对上述技术问题，本专利技术的目的在于提供一种机动车辆姿态的测量方法及测量 装置，其能够准确的得到倾角。 为实现上述目的，本专利技术采用如下技术方案： 方案一： -种机动车辆姿态的测量方法，应用于机动车辆，该机动车辆上设有巧螺仪、卫星 定位模块和加速度计;包括如下步骤：[000引步骤A:通过卫星定位模块获取车辆的航向角和瞬时速度W得到地理坐标系上的 加速度;定义地理坐标系上的向量右上角用G标记，载体坐标系上的向量右上角用C标记，载 体水平坐标系上的向量右上角用Η标记； 步骤Β:根据地理坐标上的加速度换算得到载体水平坐标系上的加速度； 步骤C:根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的比力，并 求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态；[OOW 步骤D:根据公式Q = Pi-i · D求取输出姿态，其中，Q为巧螺仪积分出的姿态，D为角 速度乘W时间间隔构造的微旋转，Pi为当前输出姿态，Pi-l为上一次输出姿态； 步骤E:将理论姿态和输出姿态进行插值处理，并将输出姿态W四元数的形式输 出。 优选的，步骤A中，根据公式化理坐标系上的加速度，其中，互6为地理 坐标系上的加速度，为瞬时速度。 优选的，步骤B中，根据公式= rH 'SG换算得到载体水平坐标系上的加速度， 其中，过Η为载体水平坐标系上的加速度，Rg人地理坐标系至载体水平坐标系的变换。 优选的，步骤C具体包括如下子步骤： 步骤C1:根据公式;+ gH得到载体水平坐标系上的比力，其中，复Η为载 体水平坐标系上的比力，gH为重力等效加速度. 步骤C2:通过加速度计获取载体坐标系下的比力，记为gC;[001引步骤C3:获取载体坐标系至载体水平坐标系的变换，记为Rg，并根据公式求得理论姿态，其中，民若为理论姿态。 优选的，步骤E具体包括如下子步骤： 步骤E1:根据公式巧=.α+ Q.(l _ α)将理论姿态和输出姿态进行插值处 理，其中，Ρ功输出姿态，α为插值权重，且α的取值范围为(0,1); 步骤Ε2:将PiW四元数的形式输出，即Pi=。 优选的，还包括步骤F:将输出姿态通过公式一、公式二和公式Ξ转换成姿态角输 出；其中，yaw为航向角，Ρ i tch为俯仰角，ro 11为横滚角。 方案二： -种机动车辆姿态的测量装置，应用于机动车辆，该机动车辆上设有巧螺仪、卫星 定位模块和加速度计;包括如下模块： 定位模块:用于通过卫星定位模块获取车辆的航向角和瞬时速度W得到地理坐标 系上的加速度;定义地理坐标系上的向量右上角用G标记，载体坐标系上的向量右上角用C 标记，载体水平坐标系上的向量右上角用Η标记； 换算模块:用于根据地理坐标上的加速度换算得到载体水平坐标系上的加速度； 变换模块:用于根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的 比力，并求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态； 求取模块：用于根据公式Q = Pi-i . D求取输出姿态，其中，Q为巧螺仪积分出的姿 态，D为角速度乘W时间间隔构造的微旋转，Pi为当前输出姿态，Pi-i为上一次输出姿态； 输出模块：用于将理论姿态和输出姿态进行插值处理，并将输出姿态W四元数的 形式输出。 相比现有技术，本专利技术的有益效果在于： 本专利技术将卫星定位、加速度计和巧螺仪结合在一起作为倾角传感器，使得输出准 确的倾角。【附图说明】 图1为本专利技术的机动车辆姿态的测量方法的流程图。【具体实施方式】 下面，结合附图W及【具体实施方式】，对本专利技术做进一步描述： 参见图1，本专利技术提供一种机动车辆姿态的测量方法，其应用于机动车辆，该机动 车辆上设有巧螺仪、卫星定位模块和加速度计，本专利技术的改进在于将运Ξ者联合起来，求得 更精确的倾角。 包括如下步骤： 步骤S1:通过卫星定位模块获取车辆的航向角和瞬时速度W得到地理坐标系上的 加速度;定义地理坐标系上的向量右上角用G标记，载体坐标系上的向量右上角用C标记，载 体水平坐标系上的向量右上角用Η标记； 地理坐标系固定在地面上，可W看做惯性系，ΧΥΖ轴方向由东北向定义;载体坐标 系固定在车上，ΧΥΖ轴方向由车的右向、前向和上向定义;载体水平坐标系，其Υ轴方向由载 体坐标系的Υ轴在水平面的投影定义，Ζ轴方向与地理坐标系相同，X轴为Ζ、Υ轴正交右手方 向。因为只设及姿态，忽略各坐标系的原点位置，姿态W矩阵和四元数的形式运算。车辆姿 态可W用载体坐标系到地理坐标系的变化表示，包含航向角、俯仰角和横滚角，而载体水平 坐标系与载体坐标系的区别是：W上变化不含俯仰角和横滚角，仅有航向角。 具体的，在步骤S1中，根据公也理坐标系上的加速度，其中，gG为 地理坐标系上的加速度，为瞬时速度。 步骤S2:根据地理坐标上的加速度换算得到载体水平坐标系上的加速度； 具体的，在步骤S2中，根据公式换算得到载体水平坐标系上的加速 度，其中，gH为载体水平坐标系上的加速度，Rg为地理坐标系至载体水平坐标系的变换。 地理坐标系至载体水平坐标系的变换仅包含航向角，可W利用航向角反算出来， Rg的作用之一是把加速度从地理坐标系变换到载体水平坐标系，因为只包含航向角，因而 Rg就是绕Z轴转航向角的旋转。 步骤S3:根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的比力， 并求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态。 具体的，步骤S3包括如下子步骤：[004引步骤S31本文档来自技高网...

【技术保护点】
一种机动车辆姿态的测量方法，应用于机动车辆，该机动车辆上设有陀螺仪、卫星定位模块和加速度计；其特征在于，包括如下步骤：步骤A:通过卫星定位模块获取车辆的航向角和瞬时速度以得到地理坐标系上的加速度；定义地理坐标系上的向量右上角用G标记，载体坐标系上的向量右上角用C标记，载体水平坐标系上的向量右上角用H标记；步骤B：根据地理坐标上的加速度换算得到载体水平坐标系上的加速度；步骤C：根据该载体水平坐标系上的加速度获取得到载体水平坐标系上的比力，并求取载体坐标系与载体水平坐标系之间的变换，之后求得理论姿态；步骤D：根据公式Q＝Pi‑1·D求取输出姿态，其中，Q为陀螺仪积分出的姿态，D为角速度乘以时间间隔构造的微旋转，Pi为当前输出姿态，Pi‑1为上一次输出姿态；步骤E：将理论姿态和输出姿态进行插值处理，并将输出姿态以四元数的形式输出。

【技术特征摘要】

【专利技术属性】
技术研发人员：鄢尤帅，禤永俊，
申请(专利权)人：广州展讯信息科技有限公司，
类型：发明
国别省市：广东;44