CN111272199A - 一种imu的安装误差角的标定方法及装置 - Google Patents
一种imu的安装误差角的标定方法及装置 Download PDFInfo
- Publication number
- CN111272199A CN111272199A CN202010207139.9A CN202010207139A CN111272199A CN 111272199 A CN111272199 A CN 111272199A CN 202010207139 A CN202010207139 A CN 202010207139A CN 111272199 A CN111272199 A CN 111272199A
- Authority
- CN
- China
- Prior art keywords
- axis
- imu
- installation error
- output
- error 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
- 238000009434 installation Methods 0.000 title claims abstract description 148
- 238000000034 method Methods 0.000 title claims abstract description 58
- 238000005259 measurement Methods 0.000 title claims abstract description 25
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000012545 processing Methods 0.000 claims description 11
- XEBWQGVWTUSTLN-UHFFFAOYSA-M phenylmercury acetate Chemical compound CC(=O)O[Hg]C1=CC=CC=C1 XEBWQGVWTUSTLN-UHFFFAOYSA-M 0.000 claims description 7
- 230000008569 process Effects 0.000 abstract description 13
- 238000010586 diagram Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 7
- 238000004590 computer program Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003068 static effect 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)
- Gyroscopes (AREA)
Abstract
本申请提供了一种IMU的安装误差角的标定方法及装置，涉及机器人技术领域。其中，安装误差角包括惯性测量单元IMU在X轴和Y轴的安装误差角，该方法包括：获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。利用该方法，简化了标定过程的操作，降低了成本并提高了的便携程度。
Description
技术领域
本申请涉及机器人技术领域，尤其涉及一种IMU的安装误差角的标定方法及装置。
背景技术
在机器人的导航定位系统中，IMU(Inertial Measurement Unit，惯性测量单元)为能够获取机器人加速度和角速度信息的六轴运动传感器，一般包含正交的三轴加速度计和正交的三轴陀螺仪。
IMU在机器人上的安装误差角是影响其测量精确度的重要因素之一。目前，机器人的IMU安装误差角需要在高精度的三自由度转台上以准确的角度和角速度输入进行标定，标定过程的操作较为复杂且成本较高。此外，由于需要额外的转台，该方法的便携程度较低。
发明内容
为了解决现有技术存在的上述技术问题，本申请提供了一种IMU的安装误差角的标定方法及装置，简化了标定过程的操作，降低了成本并提高了便携程度。
本申请实施例提供了一种IMU的安装误差角的标定方法，所述安装误差角包括惯性测量单元IMU在X轴和Y轴的安装误差角，该方法包括包括：
获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；
将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。
可选的，所述根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值，具体包括：
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
可选的，所述方法还包括：
依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
可选的，所述依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿，具体包括：
通过以下公式获取所述三轴陀螺仪的补偿后的X轴输出wx2、Y轴输出wy2和Z轴输出wz2：
通过以下公式对所述三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz进行补偿，得到补偿后的X轴输出fx2、Y轴输出fy2和Z轴输出fz2：
本申请实施例还提供了一种IMU的安装误差角的标定装置，所述安装误差角包括惯性测量单元IMU在X轴和Y轴的安装误差角，包括：第一获取单元、第二获取单元和处理单元；
所述第一获取单元，用于获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；
所述第二获取单元，用于根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；
所述处理单元，用于将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。
可选的，所述第二获取单元，具体用于：
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
可选的，所述装置还包括：补偿单元；
所述补偿单元，用于依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
本申请实施例还提供了一种存储介质，其上存储有程序，该程序被处理器执行时实现以上所述的IMU的安装误差角的标定方法。
本申请实施例还提供了一种电子设备，所述电子设备用于运行程序，其中，所述程序运行时执行以上所述的IMU的安装误差角的标定方法。
本申请实施例还提供了一种机器人，所述机器人包括惯性测量单元IMU和处理器；
所述处理器用于运行程序，其中，所述程序运行时执行以上所述的IMU的安装误差角的标定方法。
本申请所述方案至少具有以下优点：
利用该方法，通过获取机器人进行圆弧运动时IMU的三轴陀螺仪输出数据，当利用所述输出数据确定所述三轴陀螺仪的Z轴输出大于预设值时，获取预设数目个大于预设值的Z轴输出分别对应的X轴和Y轴的安装误差角的测量值，设置预设值能够避免Z轴输出较低时引起标定的相对误差较大，即当机器人进行较为明显的圆弧运动时再进行标定，降低三轴陀螺仪在角速度较低时相对误差较高带来的影响；将获取的X轴的安装误差角的测量值的平均值作为IMU在X轴上的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为IMU在Y轴上的安装误差角。本申请提供的方法利用了当IMU存在安装误差角时，当机器人进行圆弧运动便会在两个正交的水平方向上产生耦合的陀螺仪角速度输出，本申请提供的方法基于这种情况下输出的角速度进行解算和标定IMU与机器人间的水平安装误差角，从而简化了标定过程的操作，并且该方法不需要使用额外设备，降低了标定的成本还提升了便携程度。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请中记载的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。
图1为本申请实施例提供的IMU的安装误差角的标定方法的流程图；
图2为本申请实施例提供的机器人圆弧运动的场景示意图；
图3为本申请实施例提供的IMU的安装误差角的标定装置的示意图；
图4为本申请实施例提供的一种电子设备的示意图。
具体实施方式
当机器人的IMU安装完成后，不可避免存在一定的安装误差角。目前，机器人的IMU的安装误差角需要在高精度的三自由度转台上以准确的角度和角速度输入进行标定，标定过程的操作较为复杂且成本较高。
为了解决以上的技术问题，经研究和计算后发现，由于IMU包括正交的三轴加速度计和正交的三轴陀螺仪，如果与机器人间存在安装角误差，则当机器人在平坦面上进行圆弧运动时便会在两个正交的水平方向产生耦合的陀螺仪角速度输出，本申请提供的方法基于这种情况下输出的角速度进行解算和标定IMU与机器人间的水平安装误差角，从而简化了标定过程的操作，并且该方法不需要使用额外设备，降低了标定的成本还提升了便携程度。
为了使本技术领域的人员更好地理解本申请方案，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚地描述，显然，所描述的实施例仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。
实施例一：
本申请实施例提供了一种IMU的安装误差角的标定方法，下面结合附图具体说明。
参见图1，该图为本申请实施例提供的IMU的安装误差角的标定方法的流程图。
本申请实施例所述方法包括以下步骤：
S101：获取机器人进行圆弧运动时IMU的三轴陀螺仪输出数据。
经研究和计算后发现，如果IMU与机器人间存在安装角误差，则当机器人在平坦面上进行圆弧运动时便会在两个正交的水平方向上产生耦合的陀螺仪角速度输出，因此可以根据该角速度输出解算水平方向的安装误差角。
本申请实施例采用的获取该角速度的方式为控制机器人在平坦面上进行圆弧运动。
参见图2，该图为本申请实施例提供的机器人圆弧运动的场景示意图。
本申请实施例中机器人进行的圆弧运动可以不严格维持固定的圆心与固定半径，例如圆弧运动的圆心和半径可以变化，进行圆弧运动的目的是为了获取到多组在该正交水平方向(即X轴方向和Y轴方向)的角速度。
此外，为了提升标定的准确性，实际应用中机器人需在平坦面进行圆弧运动，以降低误差。
获取机器人在进行圆弧运动时IMU的三轴陀螺仪输出数据。
S102：根据输出数据获取预设数目个大于预设值的三轴陀螺仪的Z轴输出，并获取每个Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值。
当根据三轴陀螺仪输出数据确定Z轴输出大于预设值时，表征此时机器人在进行较为明显的圆弧运动，即三轴陀螺仪的角速度的输出值较大，利用此时三轴陀螺仪的输出值进行解算标定能够降低角速度较低时相对误差带来的影响。
其中，该预设值可以根据实际情况确定，本申请实施例不作具体限定，例如根据实际水平安装误差角的标定精度要求确定，可以设定为20°/秒、30°/秒等。
因此在机器人进行圆弧运动时，存在多次的三轴陀螺仪的Z轴输出大于预设值，因此能够解算获取多个相应的X轴和Y轴的安装误差角的测量值。本申请实施例中可以获取预设数目个大于预设值的三轴陀螺仪的Z轴输出，并获取每个Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值。其中，预设数目可以根据实际情况确定，本申请实施例在此不再赘述。
具体的，对于第i次解算，利用所述输出数据分别获取所述三轴陀螺仪的X轴输出wx、Y轴输出wy和Z轴输出wz，则可以通过以下公式确定第i次解算得到的X轴的安装误差角φx[i]和Y轴的安装误差角φy[i]：
S103：将获取的X轴的安装误差角的平均值作为IMU在X轴的安装误差角，将获取的Y轴的安装误差角的平均值作为IMU在Y轴的安装误差角。
为了降低误差的影响，本申请实施例获取预设数目(以下以N表示)个X轴安装误差角的测量值的平均值和预设数目个Y轴的安装误差角的测量值的平均值，进而可得本次标定过程的IMU水平安装误差角φx和φy：
实际应用中当获取IMU水平安装误差角φx和φy后，在机器人的正常工作的过程中，便可以基于标定结果实时对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿，下面具体说明。
通过以下公式获取所述三轴陀螺仪的补偿后的X轴输出wx2、Y轴输出wy2和Z轴输出wz2：
其中
为补偿后的三轴陀螺仪的X轴输出wx2、Y轴输出wy2和Z轴输出wz2形成的矩阵，
为由所述输出数据确定的未补偿的三轴陀螺仪的X轴输出wx、Y轴输出wy和Z轴输出wz形成的矩阵。
通过以下公式对所述三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz进行补偿，得到补偿后的X轴输出fx2、Y轴输出fy2和Z轴输出fz2:
其中，
为补偿后的三轴加速度计的X轴输出fx2、Y轴输出fy2和Z轴输出fz2形成的矩阵，
为未补偿的三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz形成的矩阵。
进一步的，还可以多次更换机器人进行圆弧运动的平面，再次进行水平安装误差角的标定，获取多次标定的平均值作为最终结果，以减小误差。
综上所述，利用本申请实施例提供的方法，通过获取机器人进行圆弧运动时IMU的三轴陀螺仪输出数据，当利用所述输出数据确定所述三轴陀螺仪的Z轴输出大于预设值时，获取预设数目个大于预设值的Z轴输出分别对应的X轴和Y轴的安装误差角的测量值，设置预设值能够避免Z轴输出较低时引起标定的相对误差较大，即当机器人进行较为明显的圆弧运动时再进行标定，降低三轴陀螺仪在角速度较低时相对误差较高带来的影响；将获取的X轴的安装误差角的测量值的平均值作为IMU在X轴上的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为IMU在Y轴上的安装误差角。本申请提供的方法利用了当IMU存在安装误差角时，当机器人进行圆弧运动便会在正交水平方向上产生耦合的陀螺仪角速度输出，本申请提供的方法基于这种情况下输出的角速度进行解算和标定IMU与机器人间的水平安装误差角，从而简化了标定过程的操作，并且该方法不需要使用额外设备，降低了标定的成本还提升了便携程度。
实施例二：
基于上述实施例提供的IMU的安装误差角的标定方法，本申请实施例还提供了一种IMU的安装误差角的标定装置，下面结合附图具体说明。
参见图3，该图为本申请实施例提供的一种IMU的安装误差角的标定装置的示意图。
本申请实施例所述装置包括：第一获取单元301、第二获取单元302和处理单元303。
第一获取单元301用于获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据。
第二获取单元302用于根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值。
其中，该预设数目和预设值可以根据实际情况确定，本申请实施例不作具体限定，例如根据实际水平安装误差角的标定精度要求确定。
进一步的，第二获取单元302具体用于：根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
处理单元303用于当所述圆弧运动结束后，将获取的X轴的安装误差角的平均值作为所述IMU在X轴上的安装误差角，将获取的Y轴的安装误差角的平均值作为所述IMU在Y轴上的安装误差角。
当圆弧运动结束时，可解算得到预设数目(以下用N表示)组水平安装误差角。为了减小误差，对此N个水平安装误差角计算均值，可得本次标定过程得到的IMU水平安装误差角φx和φy：
进一步的，所述装置还可以包括补偿单元。该补偿单元用于依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
进一步的，补偿单元通过以下公式获取所述三轴陀螺仪的补偿后的X轴输出wx2、Y轴输出wy2和Z轴输出wz2：
其中
为补偿后的三轴陀螺仪的X轴输出wx2、Y轴输出wy2和Z轴输出wz2形成的矩阵，
为由所述输出数据确定的未补偿的三轴陀螺仪的X轴输出wx、Y轴输出wy和Z轴输出wz形成的矩阵。
补偿单元通过以下公式对所述三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz进行补偿，得到补偿后的X轴输出fx2、Y轴输出fy2和Z轴输出fz2：
其中，
为补偿后的三轴加速度计的X轴输出fx2、Y轴输出fy2和Z轴输出fz2形成的矩阵，
为未补偿的三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz形成的矩阵。
综上所述，该装置的第一获取单元能够获取机器人进行圆弧运动时IMU的三轴陀螺仪输出数据。第二获取单元能够根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值，设置预设值能够避免Z轴输出较低时引起标定的相对误差较大，即当机器人进行较为明显的圆弧运动时再进行标定，降低三轴陀螺仪在角速度较低时相对误差较高带来的影响。处理单元能够当圆弧运动结束后，将获取的X轴的安装误差角的平均值作为IMU在X轴上的安装误差角，将获取的Y轴的安装误差角的平均值作为IMU在Y轴上的安装误差角。该装置利用了当IMU存在水平安装误差角时，当机器人进行圆弧运动便会在两个正交水平方向产生耦合的陀螺仪角速度输出，本申请提供的装置基于这种情况下输出的角速度进行解算和标定IMU与机器人间的水平安装误差角，从而简化了标定过程的操作。
所述IMU的安装误差角的标定装置包括处理器和存储器，上述第一获取单元、第二获取单元和处理单元等均作为程序单元存储在存储器中，由处理器执行存储在存储器中的上述程序单元来实现相应的功能。
处理器中包含内核，由内核去存储器中调取相应的程序单元。内核可以设置一个或以上，通过调整内核参数来实现对IMU的水平安装误差角的标定。
实施例三：
本申请实施例提供了一种存储介质，其上存储有程序，该程序被处理器执行时实现所述的IMU的安装误差角的标定方法。
本发明实施例提供了一种处理器，所述处理器用于运行程序，其中，所述程序运行时执行所述的IMU的安装误差角的标定方法。
本发明实施例提供了一种电子设备，下面结合附图具体说明。
参见图4，该图为本申请实施例提供的一种电子设备的示意图。
该电子设备40包括至少一个处理器401、以及与处理器401连接的至少一个存储器402、总线403；其中，处理器401、存储器402通过总线403完成相互间的通信；处理器401用于调用存储器402中的程序指令，以执行上述的IMU的安装误差角的标定方法。
本申请还提供了一种机器人，该机器人包括惯性测量单元IMU和处理器。所述处理器用于运行程序，其中，所述程序运行时执行所述的IMU的安装误差角的标定方法。
本申请还提供了一种计算机程序产品，当在数据处理设备上执行时，适于执行初始化有如下方法步骤的程序：
获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；
将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。
可选的，所述根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值，具体包括：
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
可选的，所述方法还包括：
依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
可选的，所述依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿，具体包括：
通过以下公式获取所述三轴陀螺仪的补偿后的X轴输出wx2、Y轴输出wy2和Z轴输出wz2：
通过以下公式对所述三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz进行补偿，得到补偿后的X轴输出fx2、Y轴输出fy2和Z轴输出fz2：
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
在一个典型的配置中，设备包括一个或多个处理器(CPU)、存储器和总线。设备还可以包括输入/输出接口、网络接口等。
存储器可能包括计算机可读介质中的非永久性存储器，随机存取存储器(RAM)和/或非易失性内存等形式，如只读存储器(ROM)或闪存(flash RAM)，存储器包括至少一个存储芯片。存储器是计算机可读介质的示例。
计算机可读介质包括永久性和非永久性、可移动和非可移动媒体可以由任何方法或技术来实现信息存储。信息可以是计算机可读指令、数据结构、程序的模块或其他数据。计算机的存储介质的例子包括，但不限于相变内存(PRAM)、静态随机存取存储器(SRAM)、动态随机存取存储器(DRAM)、其他类型的随机存取存储器(RAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、快闪记忆体或其他内存技术、只读光盘只读存储器(CD-ROM)、数字多功能光盘(DVD)或其他光学存储、磁盒式磁带，磁带磁磁盘存储或其他磁性存储设备或任何其他非传输介质，可用于存储可以被计算设备访问的信息。按照本文中的界定，计算机可读介质不包括暂存电脑可读媒体(transitory media)，如调制的数据信号和载波。
还需要说明的是，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括要素的过程、方法、商品或者设备中还存在另外的相同要素。
本领域技术人员应明白，本申请的实施例可提供为方法、系统或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
以上仅为本申请的实施例而已，并不用于限制本申请。对于本领域技术人员来说，本申请可以有各种更改和变化。凡在本申请的精神和原理之内所作的任何修改、等同替换、改进等，均应包含在本申请的权利要求范围之内。
Claims (10)
1.一种IMU的安装误差角的标定方法，其特征在于，所述安装误差角包括惯性测量单元IMU在X轴和Y轴的安装误差角，包括：
获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；
将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。
2.根据权利要求1所述的方法，其特征在于，所述根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值，具体包括：
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
3.根据权利要求2所述的方法，其特征在于，所述方法还包括：
依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
4.根据权利要求3所述的方法，其特征在于，所述依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿，具体包括：
通过以下公式获取所述三轴陀螺仪的补偿后的X轴输出wx2、Y轴输出wy2和Z轴输出wz2：
通过以下公式对所述三轴加速度计的X轴输出fx、Y轴输出fy和Z轴输出fz进行补偿，得到补偿后的X轴输出fx2、Y轴输出fy2和Z轴输出fz2：
5.一种IMU的安装误差角的标定装置，其特征在于，所述安装误差角包括惯性测量单元IMU在X轴和Y轴的安装误差角，包括：第一获取单元、第二获取单元和处理单元；
所述第一获取单元，用于获取机器人进行圆弧运动时IMU的三轴陀螺仪的输出数据；
所述第二获取单元，用于根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出，并获取每个所述Z轴输出对应的IMU在X轴和Y轴的安装误差角的测量值；
所述处理单元，用于将获取的X轴的安装误差角的测量值的平均值作为所述IMU在X轴的安装误差角，将获取的Y轴的安装误差角的测量值的平均值作为所述IMU在Y轴的安装误差角。
6.根据权利要求5所述的装置，其特征在于，所述第二获取单元，具体用于：
根据所述输出数据获取预设数目个大于预设值的所述三轴陀螺仪的Z轴输出wz，并获取每个所述Z轴输出对应的X轴输出wx和Y轴输出wy；
通过以下公式确定每个所述Z轴输出对应的IMU在X轴的安装误差角的测量值φx和Y轴的安装误差角的测量值φy，
7.根据权利要求5所述的装置，其特征在于，所述装置还包括：补偿单元；
所述补偿单元，用于依据所述IMU在X轴上的安装误差角和所述IMU在Y轴上的安装误差角，对所述IMU的三轴陀螺仪和三轴加速度计的输出数据进行补偿。
8.一种存储介质，其特征在于，其上存储有程序，该程序被处理器执行时实现权利要求1-4中任意一项所述的IMU的安装误差角的标定方法。
9.一种电子设备，其特征在于，所述电子设备用于运行程序，其中，所述程序运行时执行权利要求1-4中任意一项所述的IMU的安装误差角的标定方法。
10.一种机器人，其特征在于，所述机器人包括惯性测量单元IMU和处理器；
所述处理器用于运行程序，其中，所述程序运行时执行权利要求1-4中任意一项所述的IMU的安装误差角的标定方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010207139.9A CN111272199B (zh) | 2020-03-23 | 2020-03-23 | 一种imu的安装误差角的标定方法及装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010207139.9A CN111272199B (zh) | 2020-03-23 | 2020-03-23 | 一种imu的安装误差角的标定方法及装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111272199A true CN111272199A (zh) | 2020-06-12 |
| CN111272199B CN111272199B (zh) | 2022-09-27 |
Family
ID=70998427
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010207139.9A Active CN111272199B (zh) | 2020-03-23 | 2020-03-23 | 一种imu的安装误差角的标定方法及装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111272199B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113984090A (zh) * | 2021-10-25 | 2022-01-28 | 北京科技大学 | 一种轮式机器人imu误差在线标定与补偿方法及装置 |
| CN114877913A (zh) * | 2022-05-20 | 2022-08-09 | 广州小马智行科技有限公司 | 惯性测量单元的非正交误差标定方法、装置、设备和介质 |
Citations (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20100121601A1 (en) * | 2008-11-13 | 2010-05-13 | Honeywell International Inc. | Method and system for estimation of inertial sensor errors in remote inertial measurement unit |
| WO2010052701A1 (en) * | 2008-11-04 | 2010-05-14 | Elbit Systems Ltd. | Sensor cluster navigation device and method |
| CN101900572A (zh) * | 2010-07-09 | 2010-12-01 | 哈尔滨工程大学 | 基于三轴转台的捷联惯性系统陀螺安装误差快速测量方法 |
| CN103900566A (zh) * | 2014-03-06 | 2014-07-02 | 哈尔滨工程大学 | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 |
| CN103940443A (zh) * | 2014-03-11 | 2014-07-23 | 哈尔滨工程大学 | 一种陀螺仪误差标定的方法 |
| WO2015082935A1 (en) * | 2013-12-06 | 2015-06-11 | Renishaw Plc | Calibrating the position of motion systems by using inertial sensors |
| RU2571437C1 (ru) * | 2014-08-12 | 2015-12-20 | Акционерное общество "Московский институт электромеханики и автоматики" (АО "МИЭА") | Способ прецизионной обработки сигналов лазерного гироскопа |
| CN105180968A (zh) * | 2015-09-02 | 2015-12-23 | 北京天航华创科技股份有限公司 | 一种imu/磁强计安装失准角在线滤波标定方法 |
| CN205889553U (zh) * | 2016-07-26 | 2017-01-18 | 深圳市福盈混凝土有限公司 | 一种混凝土搅拌站的螺旋输送机 |
| US20170038207A1 (en) * | 2013-03-15 | 2017-02-09 | Innovative Solutions & Support, Inc. | Systems and methods for calibrating and adjusting a heading reference system |
| US20180156617A1 (en) * | 2016-12-04 | 2018-06-07 | Sharp Laboratories Of America, Inc. | System and Method for Selectively Enabling Inertial Measurement Unit (IMU) Sensors |
| WO2018142868A1 (ja) * | 2017-02-03 | 2018-08-09 | Thk株式会社 | 位置制御装置及び方法 |
| US20180274940A1 (en) * | 2015-10-13 | 2018-09-27 | Shanghai Huace Navigation Technology Ltd | A method for initial alignment of an inertial navigation apparatus |
| CN109211278A (zh) * | 2018-11-07 | 2019-01-15 | 中国兵器工业集团第二四研究所苏州研发中心 | 一种mimu加速度计非线性度自动标定的系统与方法 |
| CN109360250A (zh) * | 2018-12-27 | 2019-02-19 | 爱笔（北京）智能科技有限公司 | 一种对摄像装置的标定方法、设备及系统 |
| CN110359722A (zh) * | 2019-06-28 | 2019-10-22 | 五冶集团上海有限公司 | 一种钢柱校正用千斤顶支座及其使用方法 |
| CN110455312A (zh) * | 2019-08-08 | 2019-11-15 | 中国科学院长春光学精密机械与物理研究所 | 一种陀螺安装误差标校系统及其标校方法 |
| CN110873578A (zh) * | 2020-01-17 | 2020-03-10 | 立得空间信息技术股份有限公司 | 一种基于转台传递的六面体棱镜和imu安装误差标定方法 |
-
2020
- 2020-03-23 CN CN202010207139.9A patent/CN111272199B/zh active Active
Patent Citations (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2010052701A1 (en) * | 2008-11-04 | 2010-05-14 | Elbit Systems Ltd. | Sensor cluster navigation device and method |
| EP2187170A2 (en) * | 2008-11-13 | 2010-05-19 | Honeywell International | Method and system for estimation of inertial sensor errors in remote inertial measurement unit |
| US20100121601A1 (en) * | 2008-11-13 | 2010-05-13 | Honeywell International Inc. | Method and system for estimation of inertial sensor errors in remote inertial measurement unit |
| CN101900572A (zh) * | 2010-07-09 | 2010-12-01 | 哈尔滨工程大学 | 基于三轴转台的捷联惯性系统陀螺安装误差快速测量方法 |
| US20170038207A1 (en) * | 2013-03-15 | 2017-02-09 | Innovative Solutions & Support, Inc. | Systems and methods for calibrating and adjusting a heading reference system |
| US20180180417A1 (en) * | 2013-03-15 | 2018-06-28 | Innovative Solutions & Support, Inc. | Systems and methods for calibrating and adjusting a heading reference system |
| WO2015082935A1 (en) * | 2013-12-06 | 2015-06-11 | Renishaw Plc | Calibrating the position of motion systems by using inertial sensors |
| CN103900566A (zh) * | 2014-03-06 | 2014-07-02 | 哈尔滨工程大学 | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 |
| CN103940443A (zh) * | 2014-03-11 | 2014-07-23 | 哈尔滨工程大学 | 一种陀螺仪误差标定的方法 |
| RU2571437C1 (ru) * | 2014-08-12 | 2015-12-20 | Акционерное общество "Московский институт электромеханики и автоматики" (АО "МИЭА") | Способ прецизионной обработки сигналов лазерного гироскопа |
| CN105180968A (zh) * | 2015-09-02 | 2015-12-23 | 北京天航华创科技股份有限公司 | 一种imu/磁强计安装失准角在线滤波标定方法 |
| US20180274940A1 (en) * | 2015-10-13 | 2018-09-27 | Shanghai Huace Navigation Technology Ltd | A method for initial alignment of an inertial navigation apparatus |
| CN205889553U (zh) * | 2016-07-26 | 2017-01-18 | 深圳市福盈混凝土有限公司 | 一种混凝土搅拌站的螺旋输送机 |
| US20180156617A1 (en) * | 2016-12-04 | 2018-06-07 | Sharp Laboratories Of America, Inc. | System and Method for Selectively Enabling Inertial Measurement Unit (IMU) Sensors |
| WO2018142868A1 (ja) * | 2017-02-03 | 2018-08-09 | Thk株式会社 | 位置制御装置及び方法 |
| CN109211278A (zh) * | 2018-11-07 | 2019-01-15 | 中国兵器工业集团第二四研究所苏州研发中心 | 一种mimu加速度计非线性度自动标定的系统与方法 |
| CN109360250A (zh) * | 2018-12-27 | 2019-02-19 | 爱笔（北京）智能科技有限公司 | 一种对摄像装置的标定方法、设备及系统 |
| CN110359722A (zh) * | 2019-06-28 | 2019-10-22 | 五冶集团上海有限公司 | 一种钢柱校正用千斤顶支座及其使用方法 |
| CN110455312A (zh) * | 2019-08-08 | 2019-11-15 | 中国科学院长春光学精密机械与物理研究所 | 一种陀螺安装误差标校系统及其标校方法 |
| CN110873578A (zh) * | 2020-01-17 | 2020-03-10 | 立得空间信息技术股份有限公司 | 一种基于转台传递的六面体棱镜和imu安装误差标定方法 |
Non-Patent Citations (3)
| Title |
|---|
| PUNZO, VINCENZO1等: ""Speed or spacing? Cumulative variables, and convolution of model errors and time in traffic flow models validation and calibration"", 《TRANSPORTATION RESEARCH: PART B》 * |
| WU, QIUPING等: ""A Three-Stage Accelerometer Self-Calibration Technique for Space-Stable Inertial Navigation Systems"", 《SENSORS》 * |
| 李荣冰等: ""MEMS-IMU 构型设计及惯性器件安装误差标定方法"", 《中国惯性技术学报》 * |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113984090A (zh) * | 2021-10-25 | 2022-01-28 | 北京科技大学 | 一种轮式机器人imu误差在线标定与补偿方法及装置 |
| CN113984090B (zh) * | 2021-10-25 | 2023-07-04 | 北京科技大学 | 一种轮式机器人imu误差在线标定与补偿方法及装置 |
| CN114877913A (zh) * | 2022-05-20 | 2022-08-09 | 广州小马智行科技有限公司 | 惯性测量单元的非正交误差标定方法、装置、设备和介质 |
| CN114877913B (zh) * | 2022-05-20 | 2024-05-07 | 广州小马智行科技有限公司 | 惯性测量单元的非正交误差标定方法、装置、设备和介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111272199B (zh) | 2022-09-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106052595B (zh) | 基于激光陀螺捷联惯导的三轴转台轴线垂直度检测方法 | |
| CN109084806B (zh) | 标量域mems惯性系统标定方法 | |
| CN111272199B (zh) | 一种imu的安装误差角的标定方法及装置 | |
| GB2447001A (en) | System for acquiring seismic data with six components | |
| CN110567452A (zh) | 一种激光陀螺双轴旋转惯导系统姿态误差补偿方法 | |
| CN111504314B (zh) | Imu与刚体的位姿融合方法、装置、设备及存储介质 | |
| CN108507572B (zh) | 一种基于mems惯性测量单元的姿态定位误差修正方法 | |
| CN116608881A (zh) | 一种设备的标定方法、装置、设备及介质 | |
| CN110044319A (zh) | 一种捷联惯导系统减振器变形的测量方法和测量装置 | |
| CN113959464B (zh) | 一种陀螺仪辅助的加速度计现场校准方法和系统 | |
| CN112327006B (zh) | 一种imu中加速度计的标定方法及相关装置 | |
| CN112082544A (zh) | 一种imu数据补偿方法及装置 | |
| CN113375668B (zh) | 卫星导航系统的天线安装角标定方法及装置 | |
| CN112723201B (zh) | 获取支撑位置的方法、装置及工程机械、可读存储介质 | |
| CN112284421B (zh) | 一种imu内参调整方法及相关装置 | |
| CN108398576A (zh) | 一种静态误差标定系统及方法 | |
| CN109029503B (zh) | 车载陀螺仪安装角自适应校准方法及系统、存储介质及车载终端 | |
| CN111964676A (zh) | 航姿解算方法、装置、电子设备及计算机可读存储介质 | |
| CN109341684A (zh) | 组合惯导设备 | |
| CN110879066A (zh) | 一种姿态解算算法、装置及车载惯性导航系统 | |
| CN113029133B (zh) | 机器人、校正方法及计算机可读存储介质 | |
| CN115343730B (zh) | Gnss天线外参确定方法、装置与计算机可读存储介质 | |
| CN111435085B (zh) | 微机械电子惯性导航装置及其导航方法 | |
| CN115824225B (zh) | 一种静电陀螺监控器航向误差补偿方法和装置 | |
| CN111879971A (zh) | 一种imu中加速度计的标定方法及相关装置 |
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 |