CN109506674A - 一种加速度的校正方法及装置 - Google Patents

一种加速度的校正方法及装置 Download PDF

Info

Publication number
CN109506674A
CN109506674A CN201710833663.5A CN201710833663A CN109506674A CN 109506674 A CN109506674 A CN 109506674A CN 201710833663 A CN201710833663 A CN 201710833663A CN 109506674 A CN109506674 A CN 109506674A
Authority
CN
China
Prior art keywords
acceleration
axis
current time
angle
accelerometer
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.)
Granted
Application number
CN201710833663.5A
Other languages
English (en)
Other versions
CN109506674B (zh
Inventor
赵晖
罗雷刚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Alibaba China Co Ltd
Original Assignee
Autonavi Information Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Autonavi Information Technology Co Ltd filed Critical Autonavi Information Technology Co Ltd
Priority to CN201710833663.5A priority Critical patent/CN109506674B/zh
Publication of CN109506674A publication Critical patent/CN109506674A/zh
Application granted granted Critical
Publication of CN109506674B publication Critical patent/CN109506674B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Gyroscopes (AREA)

Abstract

本申请实施例公开了一种加速度的校正方法及装置,涉及车辆航迹推算技术领域。方法包括:获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度;获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度;根据所述平均速度,确定当前时刻运动方向的加速度;根据所述三轴旋转角速度和速度,确定当前时刻的向心加速度;用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。本申请可以解决现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。

Description

一种加速度的校正方法及装置
技术领域
本申请涉及车辆航迹推算技术领域,尤其涉及一种加速度的校正方法及装置。
背景技术
在车辆航迹推算(Deadreckoning,简称DR)技术领域中,为了提升车辆在立体道路(例如高架桥)上的地图匹配准确性,通常需要对车辆姿态信息进行测量,其中,车辆姿态信息可以包括俯仰角、横滚角和航向角中的任意一种或多种。
现有技术有利用单轴加速度计和车速估计车辆俯仰角的方案,如图1所示:车辆101处于上坡过程。此时车辆101上的加速度计102水平方向上的加速度A等于重力加速度g在加速度计102的水平方向的分量A1。通过重力加速度g和分量值A1,根据反三角函数,可以确定加速度计102与地面的夹角β,用β减去加速度计102的安装角α即可得到车辆行驶的坡度角φ。
在实现现有技术的过程中,发明人发现车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
发明内容
本申请的实施例提供一种加速度的校正方法及装置,以解决现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
为达到上述目的,本申请采用如下技术方案:
一种加速度的校正方法,包括:
获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度;
获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度;
根据所述平均速度,确定当前时刻运动方向的加速度;
根据所述三轴旋转角速度和速度,确定当前时刻的向心加速度;
用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
一种加速度的校正装置,包括:
加速度及角速度数据获取单元,用于获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度;
速度数据获取单元,用于获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度;
运动方向加速度确定单元,用于根据所述平均速度,确定当前时刻所述设备运动方向的加速度;
向心加速度确定单元,用于根据所述三轴旋转角速度和速度,确定当前时刻所述设备的向心加速度;
三轴加速度数据校正单元,用于用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
本申请实施例提供的一种加速度的校正方法及装置,能够根据陀螺仪当前时刻输出的三轴旋转角速度以及设备当前时刻的速度确定当前时刻的向心加速度,并根据加速度计当前时刻输出的三轴加速度减去设备运动方向的加速度和当前时刻的向心加速度,得到校正后的三轴加速度数据。可见,校正后的三轴加速度数据是经过将陀螺仪当前时刻输出的三轴旋转角速度和加速度计当前时刻输出的三轴加速度进行融合处理得到的,实现了三轴加速度的校正,而并非仅采用加速度计输出的三轴加速度,可以避免现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为现有技术中车辆在上坡时的场景示意图;
图2为本申请实施例中的对加速度进行校正,并测量车辆姿态的场景示意图;
图3为本申请实施例提供的一种加速度的校正方法的流程图一;
图4为本申请实施例提供的一种加速度的校正方法的流程图二;
图5为本申请实施例中的采用AHRS互补滤波算法进行姿态解算的流程图;
图6为本申请实施例提供的一种加速度的校正装置的结构示意图一;
图7为本申请实施例提供的一种加速度的校正装置的结构示意图二。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
为了使本领域的技术人员更好的了解本申请,如图2所示,提供了本申请实施例对加速度进行校正,并测量车辆姿态的场景,在图2中,车辆21(可以是载客汽车,也可以是其他形式的车辆)在行驶在立体平行道路上(图2中以立交桥22为例),由于立交桥22的路况复杂,使得对车辆姿态结算的精度要求提高,由于车辆21搭载有加速度计23和陀螺仪24,可通过加速度计23来感测车辆的三轴加速度数据,通过陀螺仪24来感测车辆的三轴旋转角速度数据,而加速度计23和陀螺仪24可以与车辆的行车计算机25之间进行数据通信,以向行车计算机分别传送三轴加速度数据和三轴旋转角速度数据(当然,也可以通过网络传输至其他与车辆分离的后台计算设备上),由行车计算机25完成车辆的加速度的校正。另外,本申请实施例不仅可以通过行车计算机来执行,还可以通过搭载了加速度计和陀螺仪的智能手机来执行,本申请不做任何限制。
如图3所示,本申请实施例提供一种加速度的校正方法,包括:
步骤201、获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度。
步骤202、获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度。
步骤203、根据所述平均速度,确定当前时刻运动方向的加速度。
步骤204、根据所述三轴旋转角速度和速度,确定当前时刻的向心加速度。
步骤205、用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
本申请实施例提供的一种加速度的校正方法,能够根据陀螺仪当前时刻输出的三轴旋转角速度以及设备当前时刻的速度确定当前时刻的向心加速度,并根据加速度计当前时刻输出的三轴加速度减去设备运动方向的加速度和当前时刻的向心加速度,得到校正后的三轴加速度数据。可见,校正后的三轴加速度数据是经过将陀螺仪当前时刻输出的三轴旋转角速度和加速度计当前时刻输出的三轴加速度进行融合处理得到的,实现了三轴加速度的校正,而并非仅采用加速度计输出的三轴加速度,可以避免现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
为了使本领域的技术人员更好的了解本申请,下面列举一个更为详细的实施例,如图4所示,本申请实施例提供一种加速度的校正方法,包括:
步骤301、获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度。
步骤302、获得搭载陀螺仪和加速度计的设备当前时刻的速度和平均速度。
在实际应用中,搭载陀螺仪和加速度计的设备可以为车辆,也可以是智能手机。如果所述设备是车辆,则可以通过车辆的车载诊断系统(On-Board Diagnostic,简称OBD)接口或控制器局域网络总线(Controller Area Network,简称CAN)获取车辆的速度。如所述设备为智能手机,可以通过智能手机的定位结果来确定智能手机的速度。
步骤303、根据平均速度,确定当前时刻运动方向的加速度。
步骤304、根据三轴旋转角速度和速度,确定当前时刻的向心加速度。
在实际应用中,向心加速度可以采用三轴旋转角速度和速度的乘积。
步骤305、用三轴加速度减去运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
步骤306、获取陀螺仪在当前时刻的三轴零偏值。
本申请实施例中,陀螺仪的x、y、z三个轴中,通常情况下y轴与运动方向同向。对于陀螺仪x、y轴的零偏值估计:可以基于搭载陀螺仪和加速度计的设备的运动特性选取计算方法,例如,按照车辆行驶的特性,正常行驶的车辆一般不会沿俯仰(陀螺仪x)轴或横滚(陀螺仪y)轴旋转,所以,可以获取陀螺仪x、y轴在一段预设时间的测量值的平均值作为x轴、y轴的零偏值。
x轴、y轴的零偏值计算方式可以采用如下公式所示的递推平均法:
其中,Cn表示第n时刻的陀螺仪的x轴或者y轴的零偏值,Cn-1表示第n-1时刻的陀螺仪的x轴或者y轴的零偏值,dn表示第n时刻的陀螺仪的x轴或者y轴的测量值。随着时间推移计算次数不断增加,测量值对平均值的影响会越来越小,为了快速响应零偏的变化,应当限定n的最大值,例如限定最大为1000。
另外,陀螺仪z轴的零偏值不能用上述方法进行估计,原因是由于车辆经常左右转弯,而且左右转弯次数和幅度不一定,不能正负抵消,长期平均值不能反映真实的z轴的零偏值。因此,z轴的零偏值可以通过递推最小二乘法(Recursive LeastSquare,简称RLS),估计温度模型的方法进行估算。
步骤307、用三轴旋转角速度减去所述三轴零偏值,得到校正后的三轴旋转角速度数据。
步骤308、对校正后的三轴加速度数据和三轴旋转角速度数据进行姿态解算,确定搭载陀螺仪和加速度计的设备的姿态信息。
在实际应用中,对校正后的三轴加速度数据和三轴旋转角速度数据进行姿态解算,确定搭载陀螺仪和加速度计的设备的姿态信息可以采用多种方法,例如AHRS互补滤波算法,卡尔曼滤波算法以及梯度下降算法等。
本申请以采用AHRS互补滤波算法为例进行说明。AHRS互补滤波算法即采用的是航姿参考系统(Attitude and heading reference system,简称AHRS)的姿态解算方法,如图5所示,包括:
步骤401、根据公式:对校正后的三轴加速度数据进行归一化处理,形成归一化后的三轴加速度。其中,ax为校正后的三轴加速度数据中的加速度计的x轴的加速度;ay为校正后的三轴加速度数据中的加速度计的y轴的加速度;az为校正后的三轴加速度数据中的加速度计的z轴的加速度;a'x为归一化后的三轴加速度中的x轴的加速度;a'y为归一化后的三轴加速度中的y轴的加速度;a'z为归一化后的三轴加速度中的z轴的加速度。
步骤402、提取四元数的等效余弦矩阵中的重力分量,获取第n-1时刻的四元数,并根据公式:确定第n-1时刻的三轴加速度矢量;其中,vn-1,x为第n-1时刻的三轴加速度矢量中的x轴加速度矢量;vn-1,y为第n-1时刻的三轴加速度矢量中的y轴加速度矢量;vn-1,z为第n-1时刻的三轴加速度矢量中的z轴加速度矢量;qn-1,1、qn-1,2、qn-1,3、qn-1,4为第n-1时刻的四元数。
对于此处的四元数,在n-1为1时,初始四元数可以是预先设置的初值。
步骤403、根据公式:确定第n时刻三轴的姿态矢量误差;其中,en,x为第n时刻三轴的姿态矢量误差中的x轴的姿态矢量误差;en,y为第n时刻三轴的姿态矢量误差中的y轴的姿态矢量误差;en,z为第n时刻三轴的姿态矢量误差中的z轴的姿态矢量误差;a'n,x为第n时刻的归一化后的三轴加速度中的x轴的加速度;a'n,y为第n时刻的归一化后的三轴加速度中的y轴的加速度;a'n,z为第n时刻的归一化后的三轴加速度中的z轴的加速度;所述第n时刻与第n-1时刻相差一个预先设置的采样周期时长。
步骤404、根据公式:对第n时刻三轴的姿态矢量误差进行积分,确定第n时刻三轴的姿态矢量误差的积分值;其中,为第n时刻三轴的姿态矢量误差的积分值的x轴的姿态矢量误差的积分值;为第n时刻三轴的姿态矢量误差的积分值的y轴的姿态矢量误差的积分值;为第n时刻三轴的姿态矢量误差的积分值的z轴的姿态矢量误差的积分值;为第n-1时刻三轴的姿态矢量误差的积分值的x轴的姿态矢量误差的积分值;为第n-1时刻三轴的姿态矢量误差的积分值的y轴的姿态矢量误差的积分值;为第n-1时刻三轴的姿态矢量误差的积分值的z轴的姿态矢量误差的积分值;f为预先设置的采样频率。
步骤405、根据公式:对校正后的三轴旋转角速度数据中的第n时刻的三轴旋转角速率进行互补滤波修正处理,形成修正处理后的第n时刻的三轴旋转角速率;其中,g′n,x为修正处理后的第n时刻的三轴旋转角速率中的x轴旋转角速率;g′n,y为修正处理后的第n时刻的三轴旋转角速率中的y轴旋转角速率;g′n,z为修正处理后的第n时刻的三轴旋转角速率中的z轴旋转角速率;gn,x为修正处理前的第n时刻的三轴旋转角速率中的x轴旋转角速率;gn,y为修正处理前的第n时刻的三轴旋转角速率中的y轴旋转角速率;gn,z为修正处理前的第n时刻的三轴旋转角速率中的z轴旋转角速率;kp为预先设置的比例常数;ki为预先设置的积分常数。
步骤406、根据公式:对四元数进行更新处理,形成第n时刻的四元数;其中,q′n,1、q′n,2、q′n,3、q′n,4为第n时刻的四元数。
步骤407、根据公式:对第n时刻的四元数进行归一化,形成第n时刻归一化后的四元数;其中,q″n,1、q″n,2、q″n,3、q″n,4为第n时刻归一化后的四元数。
步骤408、根据公式:进行四元数转欧拉角,确定车辆在第n时刻的俯仰测量角、横滚测量角和航向测量角;其中,为车辆在第n时刻的航向测量角;θn为车辆在第n时刻的横滚测量角;φn为车辆在第n时刻的俯仰测量角。这样,即可确定设备的姿态信息。所述设备的姿态信息包括俯仰测量角和横滚测量角。
在上述步骤308之后,可以对设备的姿态信息进行校正,继续执行步骤309至步骤310,或者继续执行步骤311至步骤312。
步骤309、根据前一时刻设备的俯仰角,确定当前时刻加速度计x轴的偏转角度Sn,x
其中,Sn-1,x为在第n-1时刻加速度计在加速度计的x轴的偏转角度。
步骤310、用当前时刻的俯仰测量角φn减去偏转角度Sn,x,得到校正后的俯仰角Jn
其中,Jn=φn-S'n。此处的校正后的俯仰角Jn可以等于运动时的坡度角。
在实际应用中,在得到校正后的俯仰角Jn(坡度角)的情况下,本申请实施例可以通过车速脉冲设备和车辆的行驶时间即可获知车辆行驶的坡长,从而根据公式:h=L×sinJn可以确定车辆行驶的高度,即坡高。根据车辆行驶的坡度角Jn和坡高,即可进行车辆在立体平行道路上的地图匹配(即识别出车辆所在的道路和位置),或者分叉道路的匹配等。
步骤311、根据前一时刻设备的横滚角,确定当前时刻加速度计y轴的偏转角度Sn,y
其中,Sn-1,y为在第n-1时刻加速度计在加速度计的y轴的偏转角度。
步骤312、用当前时刻的横滚测量角θn减去偏转角度Sn,y,得到校正后的横滚角Kn
其中,Kn=θn-Sn,y
本申请实施例提供的一种加速度的校正方法,能够根据陀螺仪当前时刻输出的三轴旋转角速度以及设备当前时刻的速度确定当前时刻的向心加速度,并根据加速度计当前时刻输出的三轴加速度减去设备运动方向的加速度和当前时刻的向心加速度,得到校正后的三轴加速度数据。可见,校正后的三轴加速度数据是经过将陀螺仪当前时刻输出的三轴旋转角速度和加速度计当前时刻输出的三轴加速度进行融合处理得到的,实现了三轴加速度的校正,而并非仅采用加速度计输出的三轴加速度,可以避免现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
对应于上述图3和图4所示的方法实施例,如图6所示,本申请实施例提供一种加速度的校正装置,包括:
加速度及角速度数据获取单元41,用于获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度。
速度数据获取单元42,用于获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度。
运动方向加速度确定单元43,用于根据所述平均速度,确定当前时刻所述设备运动方向的加速度。
向心加速度确定单元44,用于根据所述三轴旋转角速度和速度,确定当前时刻所述设备的向心加速度。
三轴加速度数据校正单元45,用于用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
进一步的,如图7所示,所述的加速度的校正装置,还包括:
三轴零偏值获取单元46,用于获取所述陀螺仪在当前时刻的三轴零偏值。
三轴旋转角速度数据校正单元47,用于用所述三轴旋转角速度减去所述三轴零偏值,得到校正后的三轴旋转角速度数据。
进一步的,如图7所示,所述的加速度的校正装置,进一步包括:
姿态解算单元48,用于对所述校正后的三轴加速度数据和三轴旋转角速度数据进行姿态解算,确定搭载所述陀螺仪和所述加速度计的设备的姿态信息。
进一步的,如图7所示,所述设备的姿态信息至少包括俯仰测量角φn,所述加速度的校正装置还包括:
x轴偏转角度确定单元49,用于根据前一时刻所述设备的俯仰角,确定当前时刻加速度计x轴的偏转角度Sn,x
俯仰角校正单元50,用于用当前时刻的俯仰测量角φn减去偏转角度Sn,x,得到校正后的俯仰角Jn
进一步的,如图7所示,所述设备的姿态信息至少包括横滚测量角θn,所述加速度的校正装置还包括:
y轴偏转角度确定单元51,用于根据前一时刻设备的横滚角,确定当前时刻加速度计y轴的偏转角度Sn,y
横滚角校正单元52,用于用当前时刻的横滚测量角θn减去偏转角度Sn,y,得到校正后的横滚角Kn
值得说明的是,本申请实施例提供的一种加速度的校正装置的具体实现方式可以参见上述图3和图4对应的方法实施例,此处不再赘述。
本申请实施例提供的一种加速度的校正装置,能够根据陀螺仪当前时刻输出的三轴旋转角速度以及设备当前时刻的速度确定当前时刻的向心加速度,并根据加速度计当前时刻输出的三轴加速度减去设备运动方向的加速度和当前时刻的向心加速度,得到校正后的三轴加速度数据。可见,校正后的三轴加速度数据是经过将陀螺仪当前时刻输出的三轴旋转角速度和加速度计当前时刻输出的三轴加速度进行融合处理得到的,实现了三轴加速度的校正,而并非仅采用加速度计输出的三轴加速度,可以避免现有技术中车辆的加速度计噪声较大,容易受车辆震动和运动的干扰,加速度计输出的加速度存在精度不高的问题。
本领域技术人员应明白,本申请的实施例可提供为方法、系统或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请可以在由计算机执行的计算机可执行指令的一般上下文中描述,例如程序模块。一般地,程序模块包括执行特定任务或实现特定抽象数据类型的例程、程序、对象、组件、数据结构等等。也可以在分布式计算环境中实践本申请,在这些分布式计算环境中,由通过通信网络而被连接的远程处理设备来执行任务。在分布式计算环境中,程序模块可以位于包括存储设备在内的本地和远程计算机存储介质中。
本说明书中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于系统实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本申请的实施例而已,并不用于限制本申请。对于本领域技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本申请的权利要求范围之内。

Claims (10)

1.一种加速度的校正方法,其特征在于,包括:
获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度;
获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度;
根据所述平均速度,确定当前时刻所述设备运动方向的加速度;
根据所述三轴旋转角速度和速度,确定当前时刻所述设备的向心加速度;
用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
2.根据权利要求1所述的加速度的校正方法,其特征在于,还包括:
获取所述陀螺仪在当前时刻的三轴零偏值;
用所述三轴旋转角速度减去所述三轴零偏值,得到校正后的三轴旋转角速度数据。
3.根据权利要求2所述的加速度的校正方法,其特征在于,所述方法进一步包括:
对所述校正后的三轴加速度数据和三轴旋转角速度数据进行姿态解算,确定搭载所述陀螺仪和所述加速度计的设备的姿态信息。
4.根据权利要求3所述的加速度的校正方法,其特征在于,所述设备的姿态信息至少包括俯仰测量角φn,所述方法还包括:
根据前一时刻所述设备的俯仰角,确定当前时刻加速度计x轴的偏转角度Sn,x
用当前时刻的俯仰测量角φn减去偏转角度Sn,x,得到校正后的俯仰角Jn
5.根据权利要求3所述的加速度的校正方法,其特征在于,所述设备的姿态信息至少包括横滚测量角θn,所述方法还包括:
根据前一时刻设备的横滚角,确定当前时刻加速度计y轴的偏转角度Sn,y
用当前时刻的横滚测量角θn减去偏转角度Sn,y,得到校正后的横滚角Kn
6.一种加速度的校正装置,其特征在于,包括:
加速度及角速度数据获取单元,用于获得加速度计当前时刻输出的三轴加速度和陀螺仪当前时刻输出的三轴旋转角速度;
速度数据获取单元,用于获得搭载所述陀螺仪和所述加速度计的设备当前时刻的速度和平均速度;
运动方向加速度确定单元,用于根据所述平均速度,确定当前时刻所述设备运动方向的加速度;
向心加速度确定单元,用于根据所述三轴旋转角速度和速度,确定当前时刻所述设备的向心加速度;
三轴加速度数据校正单元,用于用所述三轴加速度减去所述运动方向的加速度和向心加速度,得到校正后的三轴加速度数据。
7.根据权利要求6所述的加速度的校正装置,其特征在于,所述装置还包括:
三轴零偏值获取单元,用于获取所述陀螺仪在当前时刻的三轴零偏值;
三轴旋转角速度数据校正单元,用于用所述三轴旋转角速度减去所述三轴零偏值,得到校正后的三轴旋转角速度数据。
8.根据权利要求7所述的加速度的校正装置,其特征在于,所述装置进一步包括:
姿态解算单元,用于对所述校正后的三轴加速度数据和三轴旋转角速度数据进行姿态解算,确定搭载所述陀螺仪和所述加速度计的设备的姿态信息。
9.根据权利要求8所述的加速度的校正装置,其特征在于,所述设备的姿态信息至少包括俯仰测量角φn,所述装置还包括:
x轴偏转角度确定单元,用于根据前一时刻所述设备的俯仰角,确定当前时刻加速度计x轴的偏转角度Sn,x
俯仰角校正单元,用于用当前时刻的俯仰测量角φn减去偏转角度Sn,x,得到校正后的俯仰角Jn
10.根据权利要求8所述的加速度的校正装置,其特征在于,所述设备的姿态信息至少包括横滚测量角θn,所述装置还包括:
y轴偏转角度确定单元,用于根据前一时刻设备的横滚角,确定当前时刻加速度计y轴的偏转角度Sn,y
横滚角校正单元,用于用当前时刻的横滚测量角θn减去偏转角度Sn,y,得到校正后的横滚角Kn
CN201710833663.5A 2017-09-15 2017-09-15 一种加速度的校正方法及装置 Active CN109506674B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710833663.5A CN109506674B (zh) 2017-09-15 2017-09-15 一种加速度的校正方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710833663.5A CN109506674B (zh) 2017-09-15 2017-09-15 一种加速度的校正方法及装置

Publications (2)

Publication Number Publication Date
CN109506674A true CN109506674A (zh) 2019-03-22
CN109506674B CN109506674B (zh) 2021-05-25

Family

ID=65744961

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710833663.5A Active CN109506674B (zh) 2017-09-15 2017-09-15 一种加速度的校正方法及装置

Country Status (1)

Country Link
CN (1) CN109506674B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111398634A (zh) * 2020-04-07 2020-07-10 中车株洲电力机车有限公司 一种悬浮/导向传感器加速度信号的校准方法及装置
CN111912426A (zh) * 2020-08-10 2020-11-10 电子科技大学 一种基于mems imu的低成本里程计设计方法
CN112959997A (zh) * 2021-04-09 2021-06-15 潍柴动力股份有限公司 一种道路坡度计算方法及装置

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020194914A1 (en) * 2000-04-21 2002-12-26 Intersense, Inc., A Massachusetts Corporation Motion-tracking
CN1655972A (zh) * 2002-03-19 2005-08-17 汽车系统实验室公司 车辆倾翻检测系统
CN102213581A (zh) * 2010-04-08 2011-10-12 财团法人工业技术研究院 物件测量方法与系统
CN102519424A (zh) * 2011-12-15 2012-06-27 航天科工惯性技术有限公司 一种加速度计安装工装角度变化监测系统
CN106123927A (zh) * 2016-08-25 2016-11-16 西安坤蓝电子技术有限公司 一种载体加速运动时倾角误差修正方法
CN205879196U (zh) * 2016-07-19 2017-01-11 中国人民解放军军事交通学院 一种铁路运输装备监测系统
CN106443745A (zh) * 2016-10-27 2017-02-22 广州日滨科技发展有限公司 一种航向角校正的方法及装置

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020194914A1 (en) * 2000-04-21 2002-12-26 Intersense, Inc., A Massachusetts Corporation Motion-tracking
CN1655972A (zh) * 2002-03-19 2005-08-17 汽车系统实验室公司 车辆倾翻检测系统
CN102213581A (zh) * 2010-04-08 2011-10-12 财团法人工业技术研究院 物件测量方法与系统
CN102519424A (zh) * 2011-12-15 2012-06-27 航天科工惯性技术有限公司 一种加速度计安装工装角度变化监测系统
CN205879196U (zh) * 2016-07-19 2017-01-11 中国人民解放军军事交通学院 一种铁路运输装备监测系统
CN106123927A (zh) * 2016-08-25 2016-11-16 西安坤蓝电子技术有限公司 一种载体加速运动时倾角误差修正方法
CN106443745A (zh) * 2016-10-27 2017-02-22 广州日滨科技发展有限公司 一种航向角校正的方法及装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111398634A (zh) * 2020-04-07 2020-07-10 中车株洲电力机车有限公司 一种悬浮/导向传感器加速度信号的校准方法及装置
CN111912426A (zh) * 2020-08-10 2020-11-10 电子科技大学 一种基于mems imu的低成本里程计设计方法
CN112959997A (zh) * 2021-04-09 2021-06-15 潍柴动力股份有限公司 一种道路坡度计算方法及装置

Also Published As

Publication number Publication date
CN109506674B (zh) 2021-05-25

Similar Documents

Publication Publication Date Title
CN110207697B (zh) 基于角加速度计/陀螺/加速度计的惯性导航解算方法
CN110146077A (zh) 移动机器人姿态角解算方法
CN107289930B (zh) 基于mems惯性测量单元的纯惯性车辆导航方法
JP5328252B2 (ja) ナビゲーションシステムの位置検出装置および位置検出方法
CN103940425B (zh) 一种磁‑惯性组合捷联测量方法
CN106814753B (zh) 一种目标位置矫正方法、装置及系统
CN110887481B (zh) 基于mems惯性传感器的载体动态姿态估计方法
CN108458714B (zh) 一种姿态检测系统中不含重力加速度的欧拉角求解方法
CN109682377A (zh) 一种基于动态步长梯度下降的姿态估计方法
CN106370178B (zh) 移动终端设备的姿态测量方法及装置
CN109870173A (zh) 一种基于校验点的海底管道惯性导航系统的轨迹修正方法
CN105371846B (zh) 载体姿态检测方法及其系统
CN107255474B (zh) 一种融合电子罗盘和陀螺仪的pdr航向角确定方法
CN108132053B (zh) 一种行人轨迹构建方法、系统及惯性测量装置
CN105910606A (zh) 一种基于角速度差值的方向修正方法
CN109506674A (zh) 一种加速度的校正方法及装置
CN106403952A (zh) 一种动中通低成本组合姿态测量方法
US20180231577A1 (en) Velocity estimation
CN113959462A (zh) 一种基于四元数的惯性导航系统自对准方法
CN108426584B (zh) 汽车多传感器的校准方法
CN105606093A (zh) 基于重力实时补偿的惯性导航方法及装置
CN108871319B (zh) 一种基于地球重力场与地磁场序贯修正的姿态解算方法
CN111307114A (zh) 基于运动参考单元的水面舰船水平姿态测量方法
CN109211232B (zh) 一种基于最小二乘滤波的炮弹姿态估计方法
CN106643713A (zh) 对阈值平滑自适应调整的零速修正步行者轨迹的推算方法及装置

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
TA01 Transfer of patent application right

Effective date of registration: 20200429

Address after: 310052 room 508, floor 5, building 4, No. 699, Wangshang Road, Changhe street, Binjiang District, Hangzhou City, Zhejiang Province

Applicant after: Alibaba (China) Co.,Ltd.

Address before: 100080 Beijing City, Haidian District Suzhou Street No. 3 floor 16 room 2

Applicant before: AUTONAVI INFORMATION TECHNOLOGY Co.,Ltd.

TA01 Transfer of patent application right
CB03 Change of inventor or designer information

Inventor after: Zhao Hui

Inventor after: Wu Liang

Inventor after: Luo Leigang

Inventor before: Zhao Hui

Inventor before: Luo Leigang

CB03 Change of inventor or designer information
GR01 Patent grant
GR01 Patent grant