一种平衡车上陀螺仪和加速度传感器校准方法与流程

文档序号:19544520发布日期:2019-12-27 16:51阅读:3981来源:国知局

本发明涉及属于机器和仪器校准领域,具体是指一种平衡车上陀螺仪和加速度传感器校准方法。



背景技术:

三轴mems(micro-electro-mechanicalsystem,微机电系统)陀螺仪常用来测量物体三个方向的角速率信息,以实现基于所测量的角速率解算物体的姿态信息,近年来,在平衡车等领域得到了广泛应用。三轴陀螺仪的三个轴向(x轴、y轴、z轴)分别安装于三个正交面上,构成右手坐标系。由于受陀螺仪自身工作原理、结构以及集成制造、安装等因素的影响,三轴陀螺仪的三轴向之间不能正交,从而导致存在一定的测量误差。平衡车的运作原理主要是建立在一种被称为“动态稳定”(dynamicstabilization)的基本原理上,利用车体内部的陀螺仪和加速度传感器,来检测车体姿态的变化,并利用伺服控制系统,精确地驱动电机进行相应的调整,以保持系统的平衡。由于平衡车等系统的姿态测量要求较高的准确度,基于此,对陀螺仪进行误差估计及校准具有重要意义。



技术实现要素:

以解决上述背景技术中提出的问题,本发明的目的在于提供一种平衡车上陀螺仪和加速度传感器校准方法,方法简单,能够补偿三轴陀螺仪的输出值与真实值之间的偏差,提升三轴陀螺仪测量结果的准确度。

为解决上述技术问题,本发明提供的技术方案为:

一种平衡车上陀螺仪和加速度传感器校准方法,包括:获得三轴陀螺仪的三轴测量值;获得三轴加速度传感器的三轴测量值;基于水平和翻转180度量个位置的测试数值,对所述三轴加速度传感器的三轴测量值进行校准,得到校准后的三轴测量结果;

具体包括以下步骤:

1)将平衡车的主控设备放到夹具中,供电,并通过串口连接电脑pc端通过at指令控制与主控进行通讯,夹具放置到水平状态,pc通过at指令读取主控的陀螺仪的三轴的测试值记录为accx1,accy1,accz1,以及加速度传感器的三轴的测试值记录为ix1,iy1,iz1;

2)将夹具翻转180度,再次读取主控的陀螺仪的三轴的测试值记录为accx2,accy2,accz2,以及加速度传感器的三轴的测试值记录为ix2,iy2,iz2;

3)判断夹具是否正确翻转,如果accz1<0同时accz2>0说明操作员正确翻转了夹具;

4)计算校准值,写入主控设备计算方法,写入加速度传感器的校准值分别为((accx1+accx2)/2,(accy1+accy2)/2,(accz1+accz2)/2);写入主控的陀螺仪的校准值分别为((ix1+ix2)/2,(iy1+iy2)/2,(iz1+iz2)/2)。

作为改进,在所述步骤1)和步骤2)测量三轴的测试值时,保证陀螺仪x轴垂直向上并静止。

本发明的有益效果是:

本发明方法简单,三轴加速度传感器的三轴测量值进行校准,得到校准后的三轴测量结果准确,能够补偿三轴陀螺仪的输出值与真实值之间的偏差,提升三轴陀螺仪测量结果的准确度。

具体实施方式

下面用具体实施例说明本发明,并不是对本发明的限制。

实施例

一种陀螺仪和加速度传感器校准方法,包括:获得三轴陀螺仪的三轴测量值;获得三轴陀螺仪加速度传感器的测量值;基于水平和翻转180度的两个位置的测量值,对所述的陀螺仪和加速度传感器的三轴测量值进行校准,得到校准后的三轴测量结果。夹具装备是集成了水平仪的装备。上述方法,所述获得三轴加速度传感器的三轴测量值包括:获得水平位置(保证陀螺仪x轴垂直向下并静止)的三轴加速度传感器中x,y,z三个方向的值;将设备旋转180度(保证陀螺仪x轴垂直向上并静止),再获得三轴加速度传感器种的x,y,z三个方向的值;根据两次的测量值计算平均得到校准值。

具体实施步骤为:

1)将平衡车的主控设备放到夹具中,供电,并通过串口连接电脑pc端通过at指令控制与主控进行通讯,夹具放置到水平状态,pc通过at指令读取主控的陀螺仪的三轴的测试值记录为accx1,accy1,accz1,以及加速度传感器的三轴的测试值记录为ix1,iy1,iz1;

2)将夹具翻转180度,再次读取主控的陀螺仪的三轴的测试值记录为accx2,accy2,accz2,以及加速度传感器的三轴的测试值记录为ix2,iy2,iz2;

3)判断夹具是否正确翻转,如果accz1<0同时accz2>0说明操作员正确翻转了夹具;

4)计算校准值,写入主控设备计算方法,写入加速度传感器的校准值分别为((accx1+accx2)/2,(accy1+accy2)/2,(accz1+accz2)/2);写入主控的陀螺仪的校准值分别为((ix1+ix2)/2,(iy1+iy2)/2,(iz1+iz2)/2)。

以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。



技术特征:

1.一种平衡车上陀螺仪和加速度传感器校准方法,其特征在于,包括:获得三轴陀螺仪的三轴测量值;获得三轴加速度传感器的三轴测量值;基于水平和翻转180度量个位置的测试数值,对所述三轴加速度传感器的三轴测量值进行校准,得到校准后的三轴测量结果;

具体包括以下步骤:

1)将平衡车的主控设备放到夹具中,供电,并通过串口连接电脑pc端通过at指令控制与主控进行通讯,夹具放置到水平状态,pc通过at指令读取主控的陀螺仪的三轴的测试值记录为accx1,accy1,accz1,以及加速度传感器的三轴的测试值记录为ix1,iy1,iz1;

2)将夹具翻转180度,再次读取主控的陀螺仪的三轴的测试值记录为accx2,accy2,accz2,以及加速度传感器的三轴的测试值记录为ix2,iy2,iz2;

3)判断夹具是否正确翻转,如果accz1<0同时accz2>0说明操作员正确翻转了夹具;

4)计算校准值,写入主控设备计算方法,写入加速度传感器的校准值分别为((accx1+accx2)/2,(accy1+accy2)/2,(accz1+accz2)/2);写入主控的陀螺仪的校准值分别为((ix1+ix2)/2,(iy1+iy2)/2,(iz1+iz2)/2)。

2.根据权利要求1所述的一种平衡车上陀螺仪和加速度传感器校准方法,其特征在于,在所述步骤1)和步骤2)测量三轴的测试值时,保证陀螺仪x轴垂直向上并静止。


技术总结
本发明提供了一种平衡车上陀螺仪和加速度传感器校准方法,包括:获得三轴陀螺仪的三轴测量值;获得三轴加速度传感器的三轴测量值;基于水平和翻转180度量个位置的测试数值,对所述三轴加速度传感器的三轴测量值进行校准,得到校准后的三轴测量结果。本发明提供的一种平衡车上陀螺仪和加速度传感器校准方法,步骤简单,能够补偿三轴陀螺仪的输出值与真实值之间的偏差,提升三轴陀螺仪测量结果的准确度。

技术研发人员:张成赞
受保护的技术使用者:西安兆格电子信息技术有限公司
技术研发日:2019.10.30
技术公布日:2019.12.27
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1