CN107014400A - 无人机惯性导航单元的自动校准装置及校准方法 - Google Patents

无人机惯性导航单元的自动校准装置及校准方法 Download PDF

Info

Publication number
CN107014400A
CN107014400A CN201710363642.1A CN201710363642A CN107014400A CN 107014400 A CN107014400 A CN 107014400A CN 201710363642 A CN201710363642 A CN 201710363642A CN 107014400 A CN107014400 A CN 107014400A
Authority
CN
China
Prior art keywords
inertial navigation
gyroscope
navigation unit
accelerometer
axis
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
CN201710363642.1A
Other languages
English (en)
Other versions
CN107014400B (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.)
Nanjing University of Information Science and Technology
Original Assignee
Nanjing University of Information Science and Technology
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 Nanjing University of Information Science and Technology filed Critical Nanjing University of Information Science and Technology
Priority to CN201710363642.1A priority Critical patent/CN107014400B/zh
Publication of CN107014400A publication Critical patent/CN107014400A/zh
Application granted granted Critical
Publication of CN107014400B publication Critical patent/CN107014400B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

无人机惯性导航单元的自动校准装置及校准方法
技术领域
本发明涉及无人机的技术领域，尤其涉及无人机的惯性导航单元校准装置的技术领域。
背景技术
在惯性导航系统中通常会使用到陀螺仪和加速度计。陀螺仪是惯性导航系统中常用的，主要用于测量角速度；加速度计是惯性导航系统中的另外一个重要成员，主要用于测定与重力加速度方向。传统人为手动校准步骤繁琐误差较大还需经过复杂函数运算，耗时耗力。
发明内容
本发明目的是提供一种结构简单，操作方便，降低校准过程中的误差，排除人为手动校准中各方面因素的干扰，简化了操作过程的无人机惯性导航单元的自动校准装置及校准方法。
一种无人机惯性导航单元的自动校准装置，包括与计算机软件上位机通信的编码器，编码器的输出端与步进电机相连；所述步进电机通过弹性联轴节与蜗杆连接；所述蜗杆旋转控制带动涡轮旋转；所述涡轮上方搭建旋转平台；所示旋转平台内嵌固定夹具；计算机软件上位机通过通信适配器将校准系数传输至惯性导航单元的存储器中。
基于本发明的无人机惯性导航单元自动校准装置的校准方法，包括以下步骤：
步骤1：计算机软件上位机校准界面选择加速度校准，将惯性导航单元按其加速度计X测量轴方向与重力方向重合压入夹具，此时的加速度计输出为V1，静置一段时间取200次加速度计输出值，求得平均值为Vx1；再将传感器倒转180°压入夹具，此时的加速度计输出为V2，再静置一段时间取200次加速度计输出值，求得平均值为Vx2；求得加速度计X轴的加速度计比例因子Kx和加速度计零偏常值分量ax：
上述公式(1)、公式(2)中，Vx1为加速度计X轴第一次输出200次的平均值，Vx2为加速度计X轴第二次输出200次的平均值,g为重力加速度，Kx为加速度计比例因子，ax为加速度计零偏常值分量；
同理可求得加速度计Y轴、Z轴的比例因子和零偏常值分量；
步骤2：计算机软件上位机校准界面选择陀螺仪校准，将惯性导航单元摆放按其陀螺仪X轴方向压入夹具中，静止状态下取陀螺仪400次输出值rate1、rate2、rate3、…rate400，上位机控制转台旋转360°，于开始位置记录下时间为t1，此时陀螺仪输出值为rate(t1)，旋转360°之后记下时间为t2，陀螺仪在t1到t2之间输出为rate(t)，自动求得X轴方向的陀螺仪比例因子Rx和陀螺仪零偏常值分量bx；
上述公式(3)、公式(4)中π为圆周率，t1为开始位置记录下的时间，t2为旋转360°之后记录下的时间，rate(t)为陀螺仪在t1到t2之间随时间变化的输出值，rate(t1)为陀螺仪在t1时刻的输出值，Rx为陀螺仪X轴的陀螺仪比例因子，bx为陀螺仪X轴的陀螺仪零偏常值分量；
同理可求得陀螺仪Y轴、Z轴的比例因子和零偏常值分量；
步骤3：计算机软件上位机一键发送校准系数至惯性导航单元的存储器中；
步骤4：重复步骤1，观察上位机数据显示界面加速度数据是否为+-9.79，误差在+-0.1以内；若是，则进行下一步，若不是，则重复步骤1校准；
步骤5：重复步骤2，观察上位机图形显示界面的三维数据是否是360°，若是，则进行下一步，若不是，则重复步骤2校准；
步骤6：整个校准结束。
本发明的步进电机和蜗杆通过高品质弹性联轴节连接，传动同步，大大降低了偏心扰动且噪音小。
本发明的蜗轮蜗杆联动结构精密，运动舒适，可以任意正向和反向旋转且空回极小，可调整长期使用造成的空回间隙。
本发明的蜗轮上方水平搭建旋转平台，旋台的中心与旋转中心有严格的同轴度要求。
本发明的转台外圈加装刻度圈，方便初始定位和读数。
本发明的固定夹具通过不同的排放方式满足六个面惯性导航单元长宽高度，使得惯性导航单元的XYZ轴都可以无缝内嵌固定在夹具内。
本发明的通信适配器包括串口，CAN等通信方式。
本发明的校准上位机可设定所需旋转角度，显示界面包括惯性导航单元加速度计、陀螺仪、角度数据信息，并且有图形显示界面，画出各类数据的实时波形曲线图，校准界面可选择加速度或者陀螺仪校准，并且显示所有得到校准系数。
本发明的校准上位机可通过选择校准加速度计或者陀螺仪，完成对加速度计、陀螺仪XYZ轴的零偏常值分量以及比例因子的校准。
本发明旨在有效的降低校准过程中的误差，排除人为手动校准中各方面因素的干扰，简化了操作过程。夹具可以精确无缝固定惯性导航单元的各个面，非常方便惯性导航单元的拆装；惯性导航单元通过通信适配器直接与上位机通信，减少冗余线路。结构简单，操作方便。
附图说明
图1为本发明自动校准装置的结构框图。
图2为本发明自动校准装置整体结构示意图。
图3为本发明自动校准方法的操作流程示意图
图4为本发明中加速度校准后，将传感器在X轴方向正反分别水平放置，校准上位机显示加速度实时数据。
图5为本发明中陀螺仪校准后，将传感器X轴通过旋转转台分别旋转90°、180°、270°、360°，通过观察上位机实时显示的X陀螺仪数据波形图。
其中：1、计算机软件上位机；2、惯性导航单元；3、通信适配器；4、编码器；5、步进电机；6、蜗杆；7、内置涡轮；8、刻度圈；9、惯性导航单元夹具；10、RS232转USB；11、编码器显示屏。
具体实施方式
下面结合附图对本发明的技术方案进行详细描述：
如图1
一种无人机惯性导航单元的自动校准装置，包括与计算机软件上位机1通信的编码器4，编码器4的输出端与步进电机5相连；所述步进电机5通过弹性联轴节与蜗杆6连接；所述蜗杆6旋转控制带动涡轮7旋转；所述涡轮7上方搭建旋转平台；所示旋转平台内嵌固定夹具9；计算机软件上位机1通过通信适配器3将校准系数传输至惯性导航单元2的存储器中。
计算机软件上位机1设置位移量，通过编码器2发送信号给步进电机5带动旋转平台旋转相应角度。
涡轮7与旋转平台同轴设置。
旋转平台外圈加装用于初始定位和读数的刻度圈8。
基于本发明的无人机惯性导航单元自动校准装置的校准方法，包括以下步骤：
步骤1：计算机软件上位机校准界面选择加速度校准，将惯性导航单元按其加速度计X测量轴方向与重力方向重合压入夹具，此时的加速度计输出为V1，静置一段时间取200次加速度计输出值，求得平均值为Vx1；再将传感器倒转180°压入夹具，此时的加速度计输出为V2，再静置一段时间取200次加速度计输出值，求得平均值为Vx2；求得加速度计X轴的加速度计比例因子Kx和加速度计零偏常值分量ax：
上述公式(1)、公式(2)中，Vx1为加速度计X轴第一次输出200次的平均值，Vx2为加速度计X轴第二次输出200次的平均值,g为重力加速度，Kx为加速度计比例因子，ax为加速度计零偏常值分量；
同理可求得加速度计Y轴、Z轴的比例因子和零偏常值分量；
步骤2：计算机软件上位机校准界面选择陀螺仪校准，将惯性导航单元摆放按其陀螺仪X轴方向压入夹具中，静止状态下取陀螺仪400次输出值rate1、rate2、rate3、…rate400，上位机控制转台旋转旋转360°，于开始位置记录下时间为t1，此时陀螺仪输出值为rate(t1)，旋转360°之后记下时间为t2，陀螺仪在t1到t2之间输出为rate(t)，自动求得X轴方向的陀螺仪比例因子Rx和陀螺仪零偏常值分量bx；
上述公式(3)、公式(4)中π为圆周率，t1为开始位置记录下的时间，t2为旋转360°之后记录下的时间，rate(t)为陀螺仪在t1到t2之间随时间变化的输出值，rate(t1)为陀螺仪在t1时刻的输出值，Rx为陀螺仪X轴的陀螺仪比例因子，bx为陀螺仪X轴的陀螺仪零偏常值分量；
同理可求得陀螺仪Y轴、Z轴的比例因子和零偏常值分量；
步骤3：计算机软件上位机一键发送校准系数至惯性导航单元的存储器中；
步骤4：重复步骤1，观察上位机数据显示界面加速度数据是否为+-9.79，误差在+-0.1以内；若是，则进行下一步，若不是，则重复步骤1校准；
步骤5：重复步骤2，观察上位机图形显示界面的三维数据是否是360°，若是，则进行下一步，若不是，则重复步骤2校准；
步骤6：整个校准结束。

Claims (5)

1.一种无人机惯性导航单元的自动校准装置，其特征在于：包括与计算机软件上位机(1)通信的编码器(4)，编码器(4)的输出端与步进电机(5)相连；所述步进电机(5)通过弹性联轴节与蜗杆(6)连接；所述蜗杆(6)旋转控制带动涡轮(7)旋转；所述涡轮(7)上方搭建旋转平台；所示旋转平台内嵌固定夹具(9)；计算机软件上位机(1)通过通信适配器(3)将校准系数传输至惯性导航单元(2)的存储器中。
2.根据权利要求1所述的无人机惯性导航单元的自动校准装置，其特征在于：所述计算机软件上位机(1)设置位移量，通过编码器(2)发送信号给步进电机(5)带动旋转平台旋转相应角度。
3.根据权利要求1所述的无人机惯性导航单元的自动校准装置，其特征在于：所述涡轮(7)与旋转平台同轴设置。
4.根据权利要求1所述的无人机惯性导航单元的自动校准装置，其特征在于：所述旋转平台外圈加装用于初始定位和读数的刻度圈(8)。
5.基于权利要求1所述的无人机惯性导航单元自动校准装置的校准方法，其特征在于，包括以下步骤：
步骤1：计算机软件上位机校准界面选择加速度校准，将惯性导航单元按其加速度计X测量轴方向与重力方向重合压入夹具，此时的加速度计输出为V1，静置一段时间取200次加速度计输出值，求得平均值为Vx1；再将传感器倒转180°压入夹具，此时的加速度计输出为V2，再静置一段时间取200次加速度计输出值，求得平均值为Vx2；求得加速度计X轴的加速度计比例因子Kx和加速度计零偏常值分量ax：
上述公式(1)、公式(2)中，Vx1为加速度计X轴第一次输出200次的平均值，Vx2为加速度计X轴第二次输出200次的平均值,g为重力加速度，Kx为加速度计比例因子，ax为加速度计零偏常值分量；
同理可求得加速度计Y轴、Z轴的比例因子和零偏常值分量；
步骤2：计算机软件上位机校准界面选择陀螺仪校准，将惯性导航单元摆放按其陀螺仪X轴方向压入夹具中，静止状态下取陀螺仪400次输出值rate1、rate2、rate3、…rate400，上位机控制转台旋转360°，于开始位置记录下时间为t1，此时陀螺仪输出值为rate(t1)，旋转360°之后记下时间为t2，陀螺仪在t1到t2之间输出为rate(t)，自动求得X轴方向的陀螺仪比例因子Rx和陀螺仪零偏常值分量bx；
上述公式(3)、公式(4)中π为圆周率，t1为开始位置记录下的时间，t2为旋转360°之后记录下的时间，rate(t)为陀螺仪在t1到t2之间随时间变化的输出值，rate(t1)为陀螺仪在t1时刻的输出值，Rx为陀螺仪X轴的陀螺仪比例因子，bx为陀螺仪X轴的陀螺仪零偏常值分量；
同理可求得陀螺仪Y轴、Z轴的比例因子和零偏常值分量；
步骤3：计算机软件上位机一键发送校准系数至惯性导航单元的存储器中；
步骤4：重复步骤1，观察上位机数据显示界面加速度数据是否为+-9.79，误差在+-0.1以内；若是，则进行下一步，若不是，则重复步骤1校准；
步骤5：重复步骤2，观察上位机图形显示界面的三维数据是否是360°，若是，则进行下一步，若不是，则重复步骤2校准；
步骤6：整个校准结束。
CN201710363642.1A 2017-05-22 2017-05-22 无人机惯性导航单元的自动校准装置及校准方法 Active CN107014400B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710363642.1A CN107014400B (zh) 2017-05-22 2017-05-22 无人机惯性导航单元的自动校准装置及校准方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710363642.1A CN107014400B (zh) 2017-05-22 2017-05-22 无人机惯性导航单元的自动校准装置及校准方法

Publications (2)

Publication Number Publication Date
CN107014400A true CN107014400A (zh) 2017-08-04
CN107014400B CN107014400B (zh) 2023-09-26

Family

ID=59449961

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710363642.1A Active CN107014400B (zh) 2017-05-22 2017-05-22 无人机惯性导航单元的自动校准装置及校准方法

Country Status (1)

Country Link
CN (1) CN107014400B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111486871A (zh) * 2020-04-27 2020-08-04 新石器慧通（北京）科技有限公司 传感器检测方法、装置、检测设备及可读存储介质
CN114543837A (zh) * 2022-02-11 2022-05-27 上海市计量测试技术研究院 一种多计量仪校准装置
CN117191047A (zh) * 2023-11-03 2023-12-08 南京信息工程大学 弱光环境下无人机自适应主动视觉导航方法、装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013131471A1 (zh) * 2012-03-06 2013-09-12 武汉大学 一种惯性测量单元的快速标定方法
CN104614555A (zh) * 2015-01-22 2015-05-13 广东省自动化研究所 基于高斯牛顿的三轴加速度计自动校准方法
CN104949691A (zh) * 2015-06-24 2015-09-30 南京航空航天大学 基于超声电机的mems惯性器件旋转调制测试系统
CN105588567A (zh) * 2016-01-25 2016-05-18 北京航空航天大学 一种自动电子罗盘校准辅助式的航姿参考系统及方法
CN205449096U (zh) * 2015-12-29 2016-08-10 北京贞正物联网技术有限公司 一种对带有加速度计和陀螺仪的惯导系统自动标定装置
CN105973243A (zh) * 2016-07-26 2016-09-28 广州飞歌汽车音响有限公司 一种车载惯性导航系统
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN106441277A (zh) * 2016-09-28 2017-02-22 深圳市普渡科技有限公司 一种基于编码器与惯性导航单元的机器人位姿估计方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013131471A1 (zh) * 2012-03-06 2013-09-12 武汉大学 一种惯性测量单元的快速标定方法
CN104614555A (zh) * 2015-01-22 2015-05-13 广东省自动化研究所 基于高斯牛顿的三轴加速度计自动校准方法
CN104949691A (zh) * 2015-06-24 2015-09-30 南京航空航天大学 基于超声电机的mems惯性器件旋转调制测试系统
CN205449096U (zh) * 2015-12-29 2016-08-10 北京贞正物联网技术有限公司 一种对带有加速度计和陀螺仪的惯导系统自动标定装置
CN105588567A (zh) * 2016-01-25 2016-05-18 北京航空航天大学 一种自动电子罗盘校准辅助式的航姿参考系统及方法
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN105973243A (zh) * 2016-07-26 2016-09-28 广州飞歌汽车音响有限公司 一种车载惯性导航系统
CN106441277A (zh) * 2016-09-28 2017-02-22 深圳市普渡科技有限公司 一种基于编码器与惯性导航单元的机器人位姿估计方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111486871A (zh) * 2020-04-27 2020-08-04 新石器慧通（北京）科技有限公司 传感器检测方法、装置、检测设备及可读存储介质
CN114543837A (zh) * 2022-02-11 2022-05-27 上海市计量测试技术研究院 一种多计量仪校准装置
CN114543837B (zh) * 2022-02-11 2023-06-30 上海市计量测试技术研究院 一种多计量仪校准装置
CN117191047A (zh) * 2023-11-03 2023-12-08 南京信息工程大学 弱光环境下无人机自适应主动视觉导航方法、装置
CN117191047B (zh) * 2023-11-03 2024-02-23 南京信息工程大学 弱光环境下无人机自适应主动视觉导航方法、装置

Also Published As

Publication number Publication date
CN107014400B (zh) 2023-09-26

Similar Documents

Publication Publication Date Title
CN104075699B (zh) 三维固态电子罗盘及其传感器的零点和比例系数核正方法
CN107014400A (zh) 无人机惯性导航单元的自动校准装置及校准方法
CN103630076A (zh) 激光位移传感器的标定方法及装置
CN102750020A (zh) 获取空中鼠标位移的方法、空中鼠标及空中鼠标控制系统
CN100375889C (zh) 倾角仪标定系统及其标定方法
CN103162677A (zh) 一种数字地质罗盘仪及地质体产状的测量方法
CN109238177A (zh) 一种具有测量多圈角度功能的复合式角度传感器
CN106290968A (zh) 一种大空间稳态流场三维测量系统及测量方法
CN107490809A (zh) 一种重力敏感器的惯组级标定方法
CN104101363A (zh) 一种用于旋转载体横向姿态测量的陀螺仪动态标定方法
CN101614562B (zh) 具有数字化功能的指针式读数装置
CN102914414B (zh) 基于Android平台手机的振动测量仪及其检测方法
CN202869645U (zh) 基于Android平台手机的便携式振动测量仪
CN202471077U (zh) 一种矿用数字地质罗盘仪
CN103542905B (zh) 一种水表流量识别方法
CN202648654U (zh) 一种智能倾斜仪
CN100458361C (zh) 倾角仪零点和灵敏度温度补偿装置及其补偿方法
CN102243081A (zh) 激光角位传感器
CN206192340U (zh) 一种便携式倾角测量设备
CN103123361A (zh) Mems角速度和加速度传感器自动标定方法及其系统
CN206919900U (zh) 无人机惯性导航单元的自动校准装置
CN206496726U (zh) 绝对位置测量装置及医疗设备
WO2023143170A1 (zh) 一种磁球校准方法和磁球校准装置
CN203241436U (zh) 多轴微型运动传感器的校准设备
CN108592955B (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
GR01 Patent grant
GR01 Patent grant