CN106979779A - 一种无人车实时姿态测量方法 - Google Patents
一种无人车实时姿态测量方法 Download PDFInfo
- Publication number
- CN106979779A CN106979779A CN201710361133.5A CN201710361133A CN106979779A CN 106979779 A CN106979779 A CN 106979779A CN 201710361133 A CN201710361133 A CN 201710361133A CN 106979779 A CN106979779 A CN 106979779A
- Authority
- CN
- China
- Prior art keywords
- unmanned vehicle
- measuring method
- reference frame
- vehicle real
- time attitude
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1654—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with electromagnetic compass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
Landscapes
- Remote Sensing (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供了一种无人车实时姿态测量方法,包括如下步骤:(1)选定卡尔曼滤波器,并且由微型惯量测量***采集获得原始数据;(2)选择参考坐标系为NED坐标系,并忽略磁北极和真北之间的差别;(3)当载体在参考坐标系中静止,并且体坐标系和参考坐标系重合时,加速度计和磁强计测量重力加速度和地磁场在NED坐标系中的垂直分量;(4)当载体处于任意姿态时,假定加速度计和磁强计的输出,并且标示参考坐标系和体坐标系的关系;(5)综合以上信息获得联系方程组,通过姿态角与四元数的方程组,计算得到四元数。该方法可准确获得无人车的实时姿态。
Description
技术领域
本发明涉及无人车技术,特别是一种面向无人车的实时姿态测量方法。
背景技术
自20世纪60年代移动机器人诞生以来,研究人员一直梦想研究无人智能交通工具,作为智能交通***的重要组成部分,无人车排除了人为不确定因素的影响,不仅可以提高驾驶安全性,而且可以解决交通拥堵,提高能源利用率,百度曾宣布开发复杂人工智能无人车,该产品是具备环境感知、规划和自平衡控制等复杂人工智能的无人自行车,主要集合了百度在人工智能、深度学习、大数据和云计算技术的成就,然而对技术细节没有任何披露。
陀螺是最常用的姿态传感器,但是高性能陀螺的体积大,价格高,限制了陀螺在某些场合的应用,在汽车工业需求推动系下,微机械陀螺获得了很大的发展,体积小,成本低,易于批量生产,扩展了微机械陀螺的应用,然而它的精度较低,并且陀螺漂移会在短时间内引起较大的姿态误差,因此,必须与其它姿态传感器,例如GPS、倾斜计、磁强计等组合使用才能给出长期稳定可靠的无人车姿态信息。
发明内容
本发明的目的在于提供一种无人车实时姿态测量方法,包括如下步骤:
(1)选定卡尔曼滤波器,并且由微型惯量测量***采集获得原始数据;
(2)选择参考坐标系为NED坐标系,并忽略磁北极和真北之间的差别;
(3)当载体在参考坐标系中静止,并且体坐标系和参考坐标系重合时,加速度计和磁强计测量重力加速度和地磁场在NED坐标系中的垂直分量;
(4)当载体处于任意姿态时,假定加速度计和磁强计的输出,并且标示参考坐标系和体坐标系的关系;
(5)综合以上信息获得联系方程组,通过姿态角与四元数的方程组,计算得到四元数。
优选的,所述步骤(1)中的卡尔曼滤波器利用来自GSP、磁强计、加速度计和倾斜计的数据补偿陀螺偏差引起的姿态误差。
优选的,所述步骤(1)中的微型惯量测量***通过内部微处理器的处理,输出姿态和航向信息。
优选的,所述内部微处理器功耗低,通过实时卡尔曼滤波提供准确的位置和速度信息,同时提供无漂移的三维加速度、三维转速度、三维地磁场、静态压力信息。
优选的,所述步骤(3)中加速度计和磁强计的测量输出为:
gr=[0,0,g],br=[bn,0,bd],式中,g是重力加速度,bn是地磁场在NED坐标系中的北向分量,bd是地磁场在NED坐标系中的垂直分量。
优选的,所述步骤(4)中加速度计和磁强计的测量输出为:
gb=[gx,gy,gz],bb=[bx,by,bz]。
优选的,所述步骤(4)标示参考坐标系和体坐标系的关系如下:
gb=T·gr,bb=T·br
优选的,所述步骤(5)获得的方程组为:
优选的,所述步骤(5)计算获得的四元数分别为:
根据下文结合附图对本发明具体实施例的详细描述,本领域技术人员将会更加明了本发明的上述以及其他目的、优点和特征。
附图说明
后文将参照附图以示例性而非限制性的方式详细描述本发明的一些具体实施例。附图中相同的附图标记标示了相同或类似的部件或部分。本领域技术人员应该理解,这些附图未必是按比例绘制的。本发明的目标及特征考虑到如下结合附图的描述将更加明显,附图中:
图1为根据本发明实施例的方法步骤流程图。
具体实施方式
姿态就是联系动坐标系和参考坐标系角位置的参数,欧拉角和四元数是常用的表达转动的两种方式。四元数因为可以避免欧拉角的奇异问题而应用的更加广泛。四元数姿态表达式是描述姿态的最小非奇异参数集,是一种四参数的表达式,表示从一个坐标系向另一个坐标系变换,可以围绕某一单位矢量的单次旋转实现。选择参考坐标系为NED坐标系,定义坐标系如下:
N北方X
E东方Y
D垂直Z
旋转(-π,π]
θ提升[-π/2,π/2]
ψ偏移(-π,π]
体坐标系和地球坐标系的旋转矩阵(欧拉角),四元数与欧拉角的对应关系都是本领域公知的技术。
结合附图1如下详细说明一种无人车实时姿态测量方法,包括如下步骤:
(1)选定卡尔曼滤波器,并且由微型惯量测量***采集获得原始数据,其中,卡尔曼滤波器利用来自GSP、磁强计、加速度计和倾斜计的数据补偿陀螺偏差引起的姿态误差,微型惯量测量***通过内部微处理器的处理,输出姿态和航向信息,内部微处理器功耗低,通过实时卡尔曼滤波提供准确的位置和速度信息,同时提供无漂移的三维加速度、三维转速度、三维地磁场、静态压力信息。
(2)选择参考坐标系为NED坐标系,并忽略磁北极和真北之间的差别;
(3)当载体在参考坐标系中静止,并且体坐标系和参考坐标系重合时,加速度计和磁强计测量重力加速度和地磁场在NED坐标系中的垂直分量,加速度计和磁强计的测量输出为:gr=[0,0,g](1),br=[bn,0,bd](2),
式中,g是重力加速度,bn是地磁场在NED坐标系中的北向分量,bd是地磁场在NED坐标系中的垂直分量;
(4)当载体处于任意姿态时,假定加速度计和磁强计的输出,并且标示参考坐标系和体坐标系的关系,加速度计和磁强计的测量输出为:
gb=[gx,gy,gz](3),bb=[bx,by,bz] (4),
标示参考坐标系和体坐标系的关系如下:
gb=T·gr(5),bb=T·br (6);
(5)综合以上信息获得联系方程组,通过姿态角与四元数的方程组,计算得到四元数,获得的方程组为:
计算获得的四元数分别为:
将该检测方法进行***仿真与分析,初始时刻,传感器静止,此时可以测量当地的地磁参量,并且获得陀螺仪,加速度计,磁力计等主要传感器的角度表现情况,包括全尺度,现行度,偏置稳定性,噪声密度和带宽。在Matlab下进行实时仿真,该方法能够追踪运动轨迹,四元数在零点附近会出现一些正负偏差,产生奇异性问题,但不影响目标的最终姿态确定。
虽然本发明已经参考特定的说明性实施例进行了描述,但是不会受到这些实施例的限定而仅仅受到附加权利要求的限定。本领域技术人员应当理解可以在不偏离本发明的保护范围和精神的情况下对本发明的实施例能够进行改动和修改。
Claims (9)
1.一种无人车实时姿态测量方法,其特征在于包括如下步骤:
(1)选定卡尔曼滤波器,并且由微型惯量测量***采集获得原始数据;
(2)选择参考坐标系为NED坐标系,并忽略磁北极和真北之间的差别;
(3)当载体在参考坐标系中静止,并且体坐标系和参考坐标系重合时,加速度计和磁强计测量重力加速度和地磁场在NED坐标系中的垂直分量;
(4)当载体处于任意姿态时,假定加速度计和磁强计的输出,并且标示参考坐标系和体坐标系的关系;
(5)综合以上信息获得联系方程组,通过姿态角与四元数的方程组,计算得到四元数。
2.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(1)中的卡尔曼滤波器利用来自GSP、磁强计、加速度计和倾斜计的数据补偿陀螺偏差引起的姿态误差。
3.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(1)中的微型惯量测量***通过内部微处理器的处理,输出姿态和航向信息。
4.根据权利要求3的一种无人车实时姿态测量方法,所述内部微处理器功耗低,通过实时卡尔曼滤波提供准确的位置和速度信息,同时提供无漂移的三维加速度、三维转速度、三维地磁场、静态压力信息。
5.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(3)中加速度计和磁强计的测量输出为:
gr=[0,0,g],br=[bn,0,bd],式中,g是重力加速度,bn是地磁场在NED坐标系中的北向分量,bd是地磁场在NED坐标系中的垂直分量。
6.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(4)中加速度计和磁强计的测量输出为:
gb=[gx,gy,gz],bb=[bx,by,bz]。
7.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(4)标示参考坐标系和体坐标系的关系如下:
gb=T·gr,bb=T·br。
8.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(5)获得的方程组为:
9.根据权利要求1的一种无人车实时姿态测量方法,所述步骤(5)计算获得的四元数分别为:
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710361133.5A CN106979779A (zh) | 2017-05-22 | 2017-05-22 | 一种无人车实时姿态测量方法 |
PCT/CN2017/090675 WO2018214226A1 (zh) | 2017-05-22 | 2017-06-29 | 一种无人车实时姿态测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710361133.5A CN106979779A (zh) | 2017-05-22 | 2017-05-22 | 一种无人车实时姿态测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106979779A true CN106979779A (zh) | 2017-07-25 |
Family
ID=59343111
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710361133.5A Pending CN106979779A (zh) | 2017-05-22 | 2017-05-22 | 一种无人车实时姿态测量方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN106979779A (zh) |
WO (1) | WO2018214226A1 (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108982117A (zh) * | 2018-07-04 | 2018-12-11 | 长安大学 | 一种无人车测试***和方法 |
CN110095118A (zh) * | 2019-06-03 | 2019-08-06 | 北京理工大学 | 一种车身姿态角的实时测量方法及*** |
CN110954103A (zh) * | 2019-12-18 | 2020-04-03 | 无锡北微传感科技有限公司 | 基于mems传感器的车体动态姿态估计的方法及*** |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114543801A (zh) * | 2020-11-24 | 2022-05-27 | 北京振兴计量测试研究所 | 地面无人平台运动特性检测装置、方法、设备及存储介质 |
CN114252073B (zh) * | 2021-11-25 | 2023-09-15 | 江苏集萃智能制造技术研究所有限公司 | 一种机器人姿态数据融合方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其*** |
CN101290229A (zh) * | 2008-06-13 | 2008-10-22 | 哈尔滨工程大学 | 硅微航姿***惯性/地磁组合方法 |
CN101915580A (zh) * | 2010-07-14 | 2010-12-15 | 中国科学院自动化研究所 | 一种基于微惯性和地磁技术的自适应三维姿态定位方法 |
CN106342284B (zh) * | 2008-08-18 | 2011-11-23 | 西北工业大学 | 一种飞行载体姿态确定方法 |
CN102997913A (zh) * | 2011-09-14 | 2013-03-27 | 意法半导体(中国)投资有限公司 | 用于确定物体姿态的方法及装置 |
CN103776451A (zh) * | 2014-03-04 | 2014-05-07 | 哈尔滨工业大学 | 一种基于mems的高精度三维姿态惯性测量***以及测量方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7509216B2 (en) * | 2004-03-29 | 2009-03-24 | Northrop Grumman Corporation | Inertial navigation system error correction |
CN101033973B (zh) * | 2007-04-10 | 2010-05-19 | 南京航空航天大学 | 微小型飞行器微惯性组合导航***的姿态确定方法 |
CN100587641C (zh) * | 2007-08-06 | 2010-02-03 | 北京航空航天大学 | 一种适用于任意运动微小型***的定姿*** |
FR2922300B1 (fr) * | 2007-10-12 | 2009-11-20 | Saint Louis Inst | PROCEDE DE DETERMINATION DE l'ATTITUDE, DE LA POSITION ET DE LA VITESSE D'UN ENGIN MOBILE |
CN105929836B (zh) * | 2016-04-19 | 2019-07-02 | 成都翼比特自动化设备有限公司 | 用于四旋翼飞行器的控制方法 |
-
2017
- 2017-05-22 CN CN201710361133.5A patent/CN106979779A/zh active Pending
- 2017-06-29 WO PCT/CN2017/090675 patent/WO2018214226A1/zh active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其*** |
CN101290229A (zh) * | 2008-06-13 | 2008-10-22 | 哈尔滨工程大学 | 硅微航姿***惯性/地磁组合方法 |
CN106342284B (zh) * | 2008-08-18 | 2011-11-23 | 西北工业大学 | 一种飞行载体姿态确定方法 |
CN101915580A (zh) * | 2010-07-14 | 2010-12-15 | 中国科学院自动化研究所 | 一种基于微惯性和地磁技术的自适应三维姿态定位方法 |
CN102997913A (zh) * | 2011-09-14 | 2013-03-27 | 意法半导体(中国)投资有限公司 | 用于确定物体姿态的方法及装置 |
CN103776451A (zh) * | 2014-03-04 | 2014-05-07 | 哈尔滨工业大学 | 一种基于mems的高精度三维姿态惯性测量***以及测量方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108982117A (zh) * | 2018-07-04 | 2018-12-11 | 长安大学 | 一种无人车测试***和方法 |
CN110095118A (zh) * | 2019-06-03 | 2019-08-06 | 北京理工大学 | 一种车身姿态角的实时测量方法及*** |
CN110954103A (zh) * | 2019-12-18 | 2020-04-03 | 无锡北微传感科技有限公司 | 基于mems传感器的车体动态姿态估计的方法及*** |
CN110954103B (zh) * | 2019-12-18 | 2022-02-08 | 无锡北微传感科技有限公司 | 基于mems传感器的车体动态姿态估计的方法及*** |
Also Published As
Publication number | Publication date |
---|---|
WO2018214226A1 (zh) | 2018-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106979780B (zh) | 一种无人车实时姿态测量方法 | |
CN104567931B (zh) | 一种室内惯性导航定位的航向漂移误差消除方法 | |
CN106979779A (zh) | 一种无人车实时姿态测量方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
CN103196445B (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
Zahran et al. | A new velocity meter based on Hall effect sensors for UAV indoor navigation | |
CN109807911B (zh) | 基于gnss、uwb、imu、激光雷达、码盘的室外巡逻机器人多环境联合定位方法 | |
CN103439727B (zh) | 一种地面坐标的测量方法 | |
CN107218938A (zh) | 基于人体运动模型辅助的穿戴式行人导航定位方法和设备 | |
CN107490803A (zh) | 利用gps和惯导***对机器人定位定向方法 | |
Allotta et al. | Single axis FOG aided attitude estimation algorithm for mobile robots | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN105841698B (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN107490378A (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
CN101839719A (zh) | 一种基于陀螺、地磁传感器的惯性测量装置 | |
Wahdan et al. | Three-dimensional magnetometer calibration with small space coverage for pedestrians | |
CN107024206A (zh) | 一种基于ggi/gps/ins的组合导航*** | |
CN103630139A (zh) | 一种基于地磁梯度张量测量的水下载体全姿态确定方法 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
Gao et al. | An integrated land vehicle navigation system based on context awareness | |
Barczyk | Nonlinear state estimation and modeling of a helicopter UAV | |
CN109470276A (zh) | 基于零速修正的里程计标定方法与装置 | |
CN109764870A (zh) | 基于变换估计量建模方案的载体初始航向估算方法 | |
CN102997935A (zh) | 一种基于光学和惯性组合测量的自主gnc仿真试验*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170725 |