CN111765906A - 误差校准方法及装置 - Google Patents
误差校准方法及装置 Download PDFInfo
- Publication number
- CN111765906A CN111765906A CN202010745632.6A CN202010745632A CN111765906A CN 111765906 A CN111765906 A CN 111765906A CN 202010745632 A CN202010745632 A CN 202010745632A CN 111765906 A CN111765906 A CN 111765906A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- acceleration
- standard
- error angle
- angle
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 56
- 230000001133 acceleration Effects 0.000 claims abstract description 156
- 238000009434 installation Methods 0.000 claims abstract description 17
- 238000005096 rolling process Methods 0.000 claims abstract description 17
- 239000011159 matrix material Substances 0.000 claims description 56
- 238000006243 chemical reaction Methods 0.000 claims description 28
- 230000009466 transformation Effects 0.000 claims description 26
- 238000010586 diagram Methods 0.000 description 14
- 230000008569 process Effects 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011900 installation process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, 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)
- Navigation (AREA)
Abstract
本发明实施例提供的误差校准方法及装置,涉及惯性导航模块领域,所述方法包括采集预定时间内车辆处于第一预定位置时的第一加速度;将车辆的车体旋转预定角度使车辆处于第二预定位置,采集预定时间内车辆处于第二预定位置时的第二加速度;根据第一加速度及第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;根据横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角;根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准。避免了旋转车体法对于车体重量的局限性,避免了间接校准法带来的二次误差,提升了惯性导航模块的安装精度,进一步使惯性导航模块的定位更加准确。
Description
技术领域
本发明涉及惯性导航模块领域,具体而言,涉及一种误差校准方法及装置。
背景技术
装备制造业是国家重点支持的行业,亟需优化其产业结构,智能制造是产业结构转变过程中的新兴制造模式。其中,自动导引车(Automated Guided Vehicle,AGV)是实现智能制造的重要部分。
AGV之所以能够自动运行,其中定位模块起到了非常重要的作用。定位模块的定位方式很多采用惯性导航模块(Inertial measurement unit,IMU)与其它传感器的融合来实现,除了IMU的内部参数外,在安装过程中无法保证IMU坐标系与车体坐标系完全一致,如果不对IMU坐标系加以校准,将导致定位模块有非常大的误差,因此安装IMU的误差校准是必不可少的。
现有技术中,对于安装IMU的误差校准技术有旋转车体法、间接校准法等,其主要存在以下不足:
旋转车体法只适用于比较轻便的物体,例如无人机、玩具车等设备,而AGV车体比较重,因此旋转车体法并不适用于AGV。
间接校准法通常先把IMU校准到车体另外一个传感器的坐标系下,然后再计算该传感器坐标系与车体坐标系的误差,会引入二次误差,因此效果不太理想。
发明内容
本发明的目的包括,例如,提供了一种误差校准方法及装置,其能够减小将惯性导航模块安装在AGV车体上的误差。
本发明的实施例可以这样实现:
第一方面,本发明实施例提供了一种误差校准方法,应用于惯性导航模块,所述惯性导航模块安装在车辆,包括:
采集预定时间内所述车辆处于第一预定位置时的第一加速度;
将所述车辆的车体旋转预定角度使所述车辆处于第二预定位置,采集预定时间内所述车辆处于所述第二预定位置时的第二加速度;
根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;所述标准坐标系为车辆坐标系;所述实际坐标系为惯性导航模块安装的坐标系;
根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角;
根据所述横滚误差角、所述俯仰误差角及所述航向误差角对所述惯性导航模块的安装误差进行校准。
在可选的实施方式中,根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角的步骤,包括:
根据所述预定角度获取所述第一加速度与所述第二加速度之间的转化关系;
根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角;所述标准加速度包括第一标准加速度和第二标准加速度;所述第一标准加速度为所述车辆处于第一预定位置时的标准加速度;所述第二标准加速度为所述车辆处于第二预定位置时的标准加速度。
在可选的实施方式中,所述标准坐标系与实际坐标系由绕X轴的横滚角φ、绕Y轴的俯仰角θ和绕Z轴的航向角ψ三个欧拉角构成的方向余弦矩阵表示;
所述预定的转换矩阵为:
其中,T2为所述实际坐标系与所述标准坐标系之间绕Y轴的转换矩阵;T1为所述实际坐标系与所述标准坐标系之间绕Z轴的转换矩阵;T3为所述实际坐标系与所述标准坐标系之间绕X轴的转换矩阵。在可选的实施方式中,根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角的步骤,包括:
根据以下公式计算所述横滚误差角及所述俯仰误差角:
为偏差转换矩阵, 为所述实际坐标系与所述标准坐标系之间绕Y轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕Z轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕X轴的偏差转换矩阵; 其中,θerror为所述俯仰误差角;φerror为所述横滚误差角;ψerror为所述方位误差角;
在可选的实施方式中,根据所述横滚误差角、所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角的步骤,包括:
控制所述车辆匀速行走一段直线距离,获取所述车辆在所述直线距离段的第三加速度;
根据所述第三加速度、所述横滚误差角、所述俯仰误差角及所述直线距离计算所述标准坐标系与所述实际坐标系之间的航向误差角。
第二方面,本发明实施例提供了一种误差校准装置,应用于惯性导航模块,所述惯性导航模块安装在车辆,所述装置包括:
采集模块,用于采集预定时间内所述车辆处于第一预定位置时的第一加速度;
以及还用于将所述车辆的车体旋转预定角度使所述车辆处于第二预定位置,采集预定时间内所述车辆处于所述第二预定位置时的第二加速度;
处理模块,用于根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;所述标准坐标系为车辆坐标系;所述实际坐标系为惯性导航模块安装的坐标系;
以及还用于根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角;
以及还用于根据所述横滚误差角、所述俯仰误差角及所述航向误差角对所述惯性导航模块的安装误差进行校准。
在可选的实施方式中,所述处理模块根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角的方式,包括:
根据所述预定角度获取所述第一加速度与所述第二加速度之间的转化关系;
根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角;所述标准加速度包括第一标准加速度和第二标准加速度;所述第一标准加速度为所述车辆处于第一预定位置时的标准加速度;所述第二标准加速度为所述车辆处于第二预定位置时的标准加速度。
在可选的实施方式中,所述标准坐标系与实际坐标系由绕X轴的横滚角φ、绕Y轴的俯仰角θ和绕Z轴的航向角ψ三个欧拉角构成的方向余弦矩阵表示;
所述预定的转换矩阵为:
其中,T2为所述实际坐标系与所述标准坐标系之间绕Y轴的转换矩阵;T1为所述实际坐标系与所述标准坐标系之间绕Z轴的转换矩阵;T3为所述实际坐标系与所述标准坐标系之间绕X轴的转换矩阵。
在可选的实施方式中,所述处理模块根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角的方式,包括:
根据以下公式计算所述横滚误差角及所述俯仰误差角:
为偏差转换矩阵, 为所述实际坐标系与所述标准坐标系之间绕Y轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕Z轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕X轴的偏差转换矩阵; 其中,θerror为所述俯仰误差角;φerror为所述横滚误差角;ψerror为所述方位误差角;
在可选的实施方式中,所述处理模块根据所述横滚误差角、所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角的方式,包括:
控制所述车辆匀速行走一段直线距离,获取所述车辆在所述直线距离段的第三加速度;
根据所述第三加速度、所述横滚误差角、所述俯仰误差角及所述直线距离计算所述标准坐标系与所述实际坐标系之间的航向误差角。
本发明实施例的有益效果包括,例如:采集车辆处于不同位置时的加速度,通过不同位置的加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角,再根据已知的横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角,最后根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准;避免了旋转车体法对于车体重量的局限性,避免了间接校准法带来的二次误差,提升了惯性导航模块的安装精度,进一步使惯性导航模块的定位更加准确。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明实施例提供的一种车体坐标系的示意图。
图2为本发明实施例提供的一种惯性导航模块坐标系示意图。
图3为本发明实施例提供的航向角的示意图。
图4为本发明实施例提供的一种误差校准方法的流程示意图。
图5为本发明实施例提供的另一种误差校准方法的流程示意图。
图6为本发明实施例提供的第一预定位置的示意图。
图7为本发明实施例提供的第二预定位置的示意图。
图8为本发明实施例提供的航向误差角的示意图。
图9为本发明实施例提供的一种误差校准装置的功能模块示意图。
图标:100-误差校准装置;110-采集模块;120-处理模块。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,术语“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
需要说明的是,在不冲突的情况下,本发明的实施例中的特征可以相互结合。
现有技术中,对于安装IMU的误差校准技术有旋转车体法、间接校准法等,其主要存在以下不足:
旋转车体法:由于AGV车体比较重,只能绕Z轴做航向的旋转,在不借助外部设备情况下无法做到绕X轴做横滚和绕Y轴做俯仰方向旋转。因此这种旋转校准法只适用于比较轻便的物体,例如无人机、玩具车等设备。
间接校准法:间接校准法通常先把IMU校准到车体另外一个传感器的坐标系下,如激光雷达、相机等,然后再计算该传感器坐标系与车体坐标系的误差;这种方法是假设传感器坐标系相对车体为已知的,但实际也需要人为的校准,因此间接校准法会引入二次误差,且计算过程复杂、繁琐,因此效果不太理想。
在本发明实施例中,车体坐标系的定义符合右手定则,具体为:X轴为车体前向方向,Y轴为车体左侧方向,Z轴为垂直车体平面朝上方向,如图1所示。
请参考图1,为本发明实施例提供的一种车体坐标系的示意图。
请参考图2,为本发明实施例提供的一种惯性导航模块坐标系示意图。
在图2中,XYZ坐标系为车体坐标系,x'y'z'坐标系为IMU坐标系,定义z'轴与XZ平面之间构成的夹角为横滚误差角φerror,x'轴与XY平面之间构成的夹角为俯仰误差角θerror,x'轴在XY平面的投影与X轴之间夹角为航向误差角ψerror。
需要说明的是,AGV在空间的转动可以由绕X轴的横滚角φ、绕Y轴的俯仰角θ、绕Z轴的航向角ψ三个欧拉角来表示,车体坐标系与IMU坐标系之间的坐标转换用这三个欧拉角构成的方向余弦矩阵来表示。
在本实施例中,定义AGV在空间的旋转顺序为Z-X-Y,则从实际坐标系到标准坐标系之间的转化关系可以分为三次的转换:
第一次,绕Y轴旋转的俯仰角θ,定义从旋转前到旋转后的转换矩阵为:
同理,第二次,绕Z轴旋转的航向角ψ,如图3所示,定义从旋转前到旋转后的转换矩阵为:
同理,第三次旋转为绕X轴旋转的横滚角φ,定义从旋转前到旋转后的转换矩阵为:
因此,从实际坐标系转换到标准坐标系的方向余弦矩阵表示为:
请参考图4,为本发明实施例提供的一种误差校准方法的流程示意图。
步骤101,采集预定时间内车辆处于第一预定位置时的第一加速度。
步骤102,将车辆的车体旋转预定角度使车辆处于第二预定位置,采集预定时间内车辆处于第二预定位置时的第二加速度。
步骤103,根据第一加速度及第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角。
步骤104,根据横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角。
步骤105,根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准。
在本实施例中,首先采集预定时间内车辆处于第一预定位置时的第一加速度,将车辆的车体旋转预定角度使车辆处于第二预定位置,采集预定时间内车辆处于第二预定位置时的第二加速度,其中,第一预定位置与第二预定位置相差180度;然后根据第一加速度及第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角,其中,标准坐标系为车辆坐标系,实际坐标系为惯性导航模块安装的坐标系;根据横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角;最后,根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准。避免了旋转车体法对于车体重量的局限性,避免了间接校准法带来的二次误差,提升了惯性导航模块的安装精度,进一步使惯性导航模块的定位更加准确。
请参考图5,为本发明实施例提供的另一种误差校准方法的流程示意图。
需要说明的是,本实施例所提供的误差校准方法,其基本原理及产生的技术效果和上述实施例相同,为简要描述,本实施例部分未提及之处,可参考上述的实施例中相应内容。
步骤101,采集预定时间内车辆处于第一预定位置时的第一加速度。
惯性导航模块安装在AGV的车体,安装时尽可能保证惯性导航模块的安装方向与车体的方向保持一致,且靠近车体正中心。具体示意图如图1所示。
采集第一加速度时,先选择一个平面,使车辆的车体在平面上保持静止,然后通过在车体边缘划线的方式记录下车体的初始方向轮廓,并通过加速度计采集预定时间内的一组加速度数据,并求取该加速度数据的平均值,并将该平均值作为第一加速度。
请参考图6,为本发明实施例提供的第一预定位置的示意图。
需要说明的是,第一预定位置为车体边缘划线部分所包含的区域;预定时间可以是但不限于1分钟、两分钟,具体值在此不做限制。
步骤102,将车辆的车体旋转预定角度使车辆处于第二预定位置,采集预定时间内车辆处于第二预定位置时的第二加速度。
需要说明的是,在本实施例中,预定角度为180°;第二预定位置为车体处于第一预定位置时,将车体绕车体正中心旋转180°得到的区域。
请参考图7,为本发明实施例提供的第二预定位置的示意图。
将车体从第一预定位置移动到第二预定位置可以车体绕车体正中心旋转180°得到,也可以根据车体边缘划线得到的初始方向轮廓调转车头的方向。
使车辆的车体在第二预定位置的平面上保持静止,然后通过加速度计采集预定时间内的一组加速度数据,并求取该加速度数据的平均值,并将该平均值作为第二加速度。
步骤103,根据第一加速度及第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角。
需要说明的是,步骤103包括两个子步骤,本步骤中未提及之处将在其子步骤中进行详细的阐述。
子步骤103-1,根据预定角度获取第一加速度与第二加速度之间的转化关系。
在本实施例中,定义车体在第一预定位置时车体的第一加速度为A1v,定义车体在第二预定位置时车体的第二加速度为A2v。由于第一预定位置与第二预定位置相差180°,因此第一加速度与第二加速度之间的转换关系为:
子步骤103-2,根据转化关系、预定的转换矩阵及预定的标准坐标系下的标准加速度计算横滚误差角及俯仰误差角。
从实际坐标系转换到标准坐标系的方向余弦矩阵即为预定的转换矩阵。
本实施例中,根据以下公式计算所述横滚误差角及所述俯仰误差角:
其中,为偏差转换矩阵, 为所述实际坐标系与所述标准坐标系之间绕Y轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕Z轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕X轴的偏差转换矩阵; 其中,θerror为所述俯仰误差角;φerror为所述横滚误差角;ψerror为所述方位误差角。
进一步得到以下等式:
由上述等式得到:
步骤104,根据横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角。
需要说明的是,步骤104包括两个子步骤,本步骤中未提及之处将在其子步骤中进行详细的阐述。
子步骤104-1,控制车辆匀速行走一段直线距离,获取车辆在直线距离段的第三加速度。
控制车辆匀速行走一段直线距离,通过加速度计实时获取车辆在行走直线时的加速度Ab,将该加速度Ab投影到车体坐标系所在平面x'y'z,此时,惯导模块坐标系投射的平面与车体坐标系XYZ之间相差的角即为方位误差角ψerror。
加速度Ab在车体坐标系所在平面x'y'z的投影即为第三加速度Ah;
请参考图8,为本发明实施例提供的航向误差角的示意图。
子步骤104-2,根据第三加速度、横滚误差角、俯仰误差角及直线距离计算标准坐标系与实际坐标系之间的航向误差角。
通过第三加速度Ah分别在X轴、Y轴的积分式,得到:
需要说明的是,在本实施例中通过多次控制车辆匀速行走一段直线距离,来求取多个方位误差角ψerror,去掉超出预定阈值范围的ψerror,在一种优选的实施例中预定阈值范围为±5°,最后取剩下的方位误差角ψerror的平均值,将该平均值作为最终的方位误差角ψerror。
步骤105,根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准。
根据横滚误差角、俯仰误差角及航向误差角校准惯性导航模块。
综上所述,本发明实施例提供的误差校准方法,所述方法包括采集预定时间内车辆处于第一预定位置时的第一加速度;将车辆的车体旋转预定角度使车辆处于第二预定位置,采集预定时间内车辆处于第二预定位置时的第二加速度;根据第一加速度及第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;根据横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角;根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准。采集车辆处于不同位置时的加速度,通过不同位置的加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角,再根据已知的横滚误差角和俯仰误差角计算标准坐标系与实际坐标系之间的航向误差角,最后根据横滚误差角、俯仰误差角及航向误差角对惯性导航模块的安装误差进行校准;避免了旋转车体法对于车体重量的局限性,避免了间接校准法带来的二次误差,提升了惯性导航模块的安装精度,进一步使惯性导航模块的定位更加准确。
请参照图9,为本发明实施例所提供的一种误差校准装置的功能模块示意图。需要说明的是,本发明实施例所提供的一种误差校准装置100,其基本原理及产生的技术效果与前述方法实施例相同,为简要描述,本实施例中未提及部分,可参考前述方法实施例中的相应内容。误差校准装置100用于执行图4及图5所述的误差校准方法,其包括采集模块110及处理模块120。
可以理解的,在一种实施例中,通过采集模块110执行步骤101及步骤102。
可以理解的,在一种实施例中,通过处理模块120执行步骤103、步骤104及步骤105。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和框图显示了根据本发明的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的***来实现,或者可以用专用硬件与计算机指令的组合来实现。
另外,在本发明各个实施例中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。
所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种误差校准方法,应用于惯性导航模块,所述惯性导航模块安装在车辆,其特征在于,所述方法包括:
采集预定时间内所述车辆处于第一预定位置时的第一加速度;
将所述车辆的车体旋转预定角度使所述车辆处于第二预定位置,采集预定时间内所述车辆处于所述第二预定位置时的第二加速度;
根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;所述标准坐标系为车辆坐标系;所述实际坐标系为惯性导航模块安装的坐标系;
根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角;
根据所述横滚误差角、所述俯仰误差角及所述航向误差角对所述惯性导航模块的安装误差进行校准。
2.根据权利要求1所述的方法,其特征在于,根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角的步骤,包括:
根据所述预定角度获取所述第一加速度与所述第二加速度之间的转化关系;
根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角;所述标准加速度包括第一标准加速度和第二标准加速度;所述第一标准加速度为所述车辆处于第一预定位置时的标准加速度;所述第二标准加速度为所述车辆处于第二预定位置时的标准加速度。
4.根据权利要求3所述的方法,其特征在于,根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角的步骤,包括:
根据以下公式计算所述横滚误差角及所述俯仰误差角:
为偏差转换矩阵, 为所述实际坐标系与所述标准坐标系之间绕Y轴的偏差转换矩阵;T1 error为所述实际坐标系与所述标准坐标系之间绕Z轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕X轴的偏差转换矩阵; 其中,θerror为所述俯仰误差角;φerror为所述横滚误差角;ψerror为所述方位误差角;
5.根据权利要求4所述的方法,其特征在于,根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角的步骤,包括:
控制所述车辆匀速行走一段直线距离,获取所述车辆在所述直线距离段的第三加速度;
根据所述第三加速度、所述横滚误差角、所述俯仰误差角及所述直线距离计算所述标准坐标系与所述实际坐标系之间的航向误差角。
6.一种误差校准装置,应用于惯性导航模块,所述惯性导航模块安装在车辆,其特征在于,所述装置包括:
采集模块,用于采集预定时间内所述车辆处于第一预定位置时的第一加速度;
以及还用于将所述车辆的车体旋转预定角度使所述车辆处于第二预定位置,采集预定时间内所述车辆处于所述第二预定位置时的第二加速度;
处理模块,用于根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角;所述标准坐标系为车辆坐标系;所述实际坐标系为惯性导航模块安装的坐标系;
以及还用于根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角;
以及还用于根据所述横滚误差角、所述俯仰误差角及所述航向误差角对所述惯性导航模块的安装误差进行校准。
7.根据权利要求6所述的装置,其特征在于,所述处理模块根据所述第一加速度及所述第二加速度计算标准坐标系与实际坐标系之间的横滚误差角及俯仰误差角的方式,包括:
根据所述预定角度获取所述第一加速度与所述第二加速度之间的转化关系;
根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角;所述标准加速度包括第一标准加速度和第二标准加速度;所述第一标准加速度为所述车辆处于第一预定位置时的标准加速度;所述第二标准加速度为所述车辆处于第二预定位置时的标准加速度。
9.根据权利要求8所述的装置,其特征在于,所述处理模块根据所述转化关系、预定的转换矩阵及预定的所述标准坐标系下的标准加速度计算所述横滚误差角及所述俯仰误差角的方式,包括:
根据以下公式计算所述横滚误差角及所述俯仰误差角:
为偏差转换矩阵, 为所述实际坐标系与所述标准坐标系之间绕Y轴的偏差转换矩阵;T1 error为所述实际坐标系与所述标准坐标系之间绕Z轴的偏差转换矩阵;为所述实际坐标系与所述标准坐标系之间绕X轴的偏差转换矩阵; 其中,θerror为所述俯仰误差角;φerror为所述横滚误差角;ψerror为所述方位误差角;
10.根据权利要求6所述的装置,其特征在于,所述处理模块根据所述横滚误差角和所述俯仰误差角计算所述标准坐标系与所述实际坐标系之间的航向误差角的方式,包括:
控制所述车辆匀速行走一段直线距离,获取所述车辆在所述直线距离段的第三加速度;
根据所述第三加速度、所述横滚误差角、所述俯仰误差角及所述直线距离计算所述标准坐标系与所述实际坐标系之间的航向误差角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010745632.6A CN111765906B (zh) | 2020-07-29 | 2020-07-29 | 误差校准方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010745632.6A CN111765906B (zh) | 2020-07-29 | 2020-07-29 | 误差校准方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111765906A true CN111765906A (zh) | 2020-10-13 |
CN111765906B CN111765906B (zh) | 2022-06-14 |
Family
ID=72727825
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010745632.6A Active CN111765906B (zh) | 2020-07-29 | 2020-07-29 | 误差校准方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111765906B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113029200A (zh) * | 2021-03-29 | 2021-06-25 | 上海景吾智能科技有限公司 | 基于机器人传感器测试航向角、精度的方法、***及介质 |
CN114088114A (zh) * | 2021-11-19 | 2022-02-25 | 智道网联科技(北京)有限公司 | 车辆位姿校准方法、装置和电子设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060142920A1 (en) * | 2004-12-24 | 2006-06-29 | Hitoshi Hashiba | Method for correcting the outputs of vehicle behavior sensor |
CN102721417A (zh) * | 2011-12-23 | 2012-10-10 | 北京理工大学 | 一种捷联惯性导航***凝固惯性系粗对准误差抑制方法 |
CN102788597A (zh) * | 2012-08-16 | 2012-11-21 | 辽宁工程技术大学 | 基于空间稳定的旋转捷联惯导***误差抑制方法 |
CN103606206A (zh) * | 2013-09-18 | 2014-02-26 | 武汉理工大学 | 一种汽车行驶状态感知装置及方法 |
CN105203098A (zh) * | 2015-10-13 | 2015-12-30 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN105509738A (zh) * | 2015-12-07 | 2016-04-20 | 西北工业大学 | 基于惯导/多普勒雷达组合的车载定位定向方法 |
CN107830873A (zh) * | 2017-11-01 | 2018-03-23 | 北京航空航天大学 | 一种基于单轴水平旋转惯导与里程计组合的高精度车辆定位定向方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导***标定方法 |
CN110926468A (zh) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | 基于传递对准的动中通天线多平台航姿确定方法 |
-
2020
- 2020-07-29 CN CN202010745632.6A patent/CN111765906B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060142920A1 (en) * | 2004-12-24 | 2006-06-29 | Hitoshi Hashiba | Method for correcting the outputs of vehicle behavior sensor |
CN102721417A (zh) * | 2011-12-23 | 2012-10-10 | 北京理工大学 | 一种捷联惯性导航***凝固惯性系粗对准误差抑制方法 |
CN102788597A (zh) * | 2012-08-16 | 2012-11-21 | 辽宁工程技术大学 | 基于空间稳定的旋转捷联惯导***误差抑制方法 |
CN103606206A (zh) * | 2013-09-18 | 2014-02-26 | 武汉理工大学 | 一种汽车行驶状态感知装置及方法 |
CN105203098A (zh) * | 2015-10-13 | 2015-12-30 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN105509738A (zh) * | 2015-12-07 | 2016-04-20 | 西北工业大学 | 基于惯导/多普勒雷达组合的车载定位定向方法 |
CN107830873A (zh) * | 2017-11-01 | 2018-03-23 | 北京航空航天大学 | 一种基于单轴水平旋转惯导与里程计组合的高精度车辆定位定向方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导***标定方法 |
CN110926468A (zh) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | 基于传递对准的动中通天线多平台航姿确定方法 |
Non-Patent Citations (1)
Title |
---|
张辉等: "三轴加速度传感器安装误差标定方法研究", 《传感技术学报》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113029200A (zh) * | 2021-03-29 | 2021-06-25 | 上海景吾智能科技有限公司 | 基于机器人传感器测试航向角、精度的方法、***及介质 |
CN114088114A (zh) * | 2021-11-19 | 2022-02-25 | 智道网联科技(北京)有限公司 | 车辆位姿校准方法、装置和电子设备 |
CN114088114B (zh) * | 2021-11-19 | 2024-02-13 | 智道网联科技(北京)有限公司 | 车辆位姿校准方法、装置和电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN111765906B (zh) | 2022-06-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9753144B1 (en) | Bias and misalignment compensation for 6-DOF IMU using GNSS/INS data | |
CN110081881B (zh) | 一种基于无人机多传感器信息融合技术的着舰引导方法 | |
US10655983B2 (en) | Method for calibrating aircraft tri-axial balance and device thereof | |
CN111812669B (zh) | 绕机检查装置及其定位方法、存储介质 | |
CN111060131B (zh) | 一种基于激光雷达的机器人精确姿态矫正方法及装置 | |
CN111765906B (zh) | 误差校准方法及装置 | |
CN112346104A (zh) | 一种无人机信息融合定位方法 | |
CN111983550B (zh) | 基于gps的无线电测向精度测试方法 | |
CN107741223B (zh) | 磁罗盘校准方法、装置及无人机 | |
CN117685953A (zh) | 面向多无人机协同定位的uwb与视觉融合定位方法及*** | |
CN115683170B (zh) | 基于雷达点云数据融合误差的校准方法 | |
CN116753953A (zh) | 一种基于视觉的无人机组合导航方法 | |
CN116047480A (zh) | 一种激光雷达到姿态传感器的外参标定方法 | |
CN114370872B (zh) | 车辆姿态确定方法和车辆 | |
CN113932835B (zh) | 自动驾驶车辆定位杆臂的标定方法、装置及电子设备 | |
CN115308785A (zh) | 一种基于多传感器融合的无人车自主定位方法 | |
CN111812668B (zh) | 绕机检查装置及其定位方法、存储介质 | |
CN114325610A (zh) | 一种基于动态测量数据的雷达安装误差校正方法 | |
Kwon et al. | Real-time observability-aware inertia parameter estimation for quadrotors | |
CN117346768B (zh) | 同时适用于室内外的多传感器融合感知定位方法 | |
CN113340271B (zh) | 一种基于无人机微群的地面目标定位误差实时估计方法 | |
CN112504272B (zh) | 一种快速无人机路径重构方法 | |
CN116295281A (zh) | 无人机目标定位方法、***、电子设备及计算机存储介质 | |
CN114802816B (zh) | 一种基于仅测角航天器轨道面内的规避方法及*** | |
Do et al. | An Adaptive Approach based on Multi-State Constraint Kalman Filter for UAVs |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |