基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置制造方法及图纸

基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置，属于惯性导航技术领域。该装置由惯性测量单元、旋转平台、控制单元和计算单元构成；惯性测量单元通过集成的陀螺仪和加速度计分别测量角速率和加速度；计算单元通过角速率和加速度分别计算惯性测量单元的倾角数值；旋转平台控制惯性测量单元旋转以改变姿态；通过旋转前后不同姿态下的倾角数值和陀螺漂移的数学关系实现陀螺漂移的估计，并补偿漂移以提高姿态定位精度。本发明专利技术的特点在于：无需磁场计或GPS等外部传感器的辅助，仅通过控制惯性测量单元旋转即可估计陀螺仪的漂移，减少长时间内姿态角尤其是航向角的积累误差。

【技术实现步骤摘要】
【专利摘要】基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置，属于惯性导航
。该装置由惯性测量单元、旋转平台、控制单元和计算单元构成；惯性测量单元通过集成的陀螺仪和加速度计分别测量角速率和加速度；计算单元通过角速率和加速度分别计算惯性测量单元的倾角数值；旋转平台控制惯性测量单元旋转以改变姿态；通过旋转前后不同姿态下的倾角数值和陀螺漂移的数学关系实现陀螺漂移的估计，并补偿漂移以提高姿态定位精度。本专利技术的特点在于：无需磁场计或GPS等外部传感器的辅助，仅通过控制惯性测量单元旋转即可估计陀螺仪的漂移，减少长时间内姿态角尤其是航向角的积累误差。【专利说明】基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置
本专利技术属于惯性导航
，特别涉及一种基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置，适合于移动机器人在室内、强磁干扰等作业环境下利用惯性测量单元进行姿态定位。
技术介绍
惯性导航法是一种常见的姿态测量方法。通过对三轴陀螺仪所测量的运动角速度进行积分，能够计算得到姿态信息。但是由于陀螺仪存在漂移问题，长时间累积计算会产生较大误差，需要利用其他传感器获得的信息对陀螺仪的漂移进行估计和误差补偿。已有陀螺仪漂移估计补偿方法，如专利“用于对位置测量装置中的漂移进行补偿方法”(CN103109159A)采用低通过滤加速度计信号来补偿陀螺仪漂移造成的误差，但对于漂移造成的平行于铅垂线方向上的误差，需要通过磁罗盘来进行补偿。该方法的不足之处在于:不适合在周围有强磁场干扰的环境下应用。如专利“车辆用陀螺仪的角速度误差修正装置、修正方法”(CN103206965A)，采用GPS接收器检测的车辆速度和防伪对陀螺仪传感器输出的角速度误差进行修正，该方法的不足之处在于:不适合在封闭空间下GPS信号微弱的环境下应用，例如室内、煤矿等场合。已有的单轴或多轴旋转惯性器件的装置及方法，如专利“一种双轴旋转光纤捷联惯性导航装置”(CN102980578)，这类装置及方法的不足之处在于:不具有漂移估计的功能，当旋转运动无法将陀螺仪的漂移互相抵消时，装置及方法应用受到限制。专利“Inertialmeasurement system with self correction”(US8010308)提出了利用加速度计估计陀螺处于铅垂方向时的漂移以修正航向角的方法。该方法需要确保旋转轴绕水平方向以保证修正精度，不适用于姿态测量系统的姿态角处于任意值的情形。综上所述，目前对陀螺仪漂移进行估计的方法，都需要在磁场计或GPS等外部传感器的辅助下实现。而当作业环境中磁强计和GPS信号不可靠时，这些附加传感器以及相关的陀螺仪漂移估计方法应用受到限制。例如一种面向大型水轮机叶片表面检测的爬壁移动机器人，由于机器人的坑内作业环境为封闭空间并有强磁场干扰，现有的姿态定位方法无法应用。因此，迫切需要不依靠GPS、磁强计等外界辅助方式，仅利用惯性测量元件自身集成的陀螺仪和加速度计来估计陀螺仪的漂移以减小姿态定位误差的方法。
技术实现思路
本专利技术的目的是针对已有技术的不足之处，提供一种利用惯性测量单元(Inertial Measurement Unit,简称IMU)旋转实现对陀螺漂移估计并补偿的方法及装置，克服常见的惯性导航方法需要磁场计或GPS等外部传感器辅助的问题。为实现上述目的，本专利技术的技术方案如下:本专利技术所述的基于惯性测量单元旋转的陀螺漂移估计补偿方法，其特征在于该方法包括以下步骤:1)通过惯性测量单元所集成的陀螺仪和加速度计测量角速率和加速度；2)通过陀螺仪测量的角速率计算时间间隔At内惯性测量单元的倾角的变化数值:【权利要求】1.一种基于惯性测量单元旋转的陀螺漂移估计补偿方法，其特征在于该方法包括以下步骤: 1)通过惯性测量单元所集成的陀螺仪和加速度计测量角速率和加速度； 通过陀螺仪测量的角速率计算时间间隔At内惯性测量单元的倾角的变化数值 2.如权利要求1所述的一种基于惯性测量单元旋转的陀螺漂移估计补偿方法，其特征在于:所述的欧拉角采用如下定义: 导航坐标系定义为onxnynzn ;惯性测量单元坐标系定义为obxbybzb ;导航坐标系onxnynzn绕zn车由转(-Ψ)角得ox3y3z3,ox3y3z3绕X3车由转Θ角得ox2y2z2, ox2y2z2再绕y2车由转Φ角，则得惯性测量单元坐标系obxbybzb ;从导航坐标系到惯性测量单元坐标系的转换矩阵R就是惯性测量单元的姿态矩阵: 3.如权利要求1所述的一种基于惯性测量单元旋转的陀螺漂移估计补偿方法，其特征在于:所述的新姿态下的横滚角Φ,、俯仰角Θ，的计算方法为: 1)根据u和△α计算惯性测量单元所在坐标系的旋转矩阵S: 4.实现如权利要求1~3所述方法的一种基于惯性测量单元旋转的陀螺仪漂移估计补偿装置，其特征在于:该装置包括惯性测量单元(I)、旋转平台(2)、控制单元(3)和计算单元(4);所述的旋转平台包括基座(21)、旋转架(22)和旋转电磁设备(23);所述的惯性测量单元固接于旋转架上，所述的旋转架套固在旋转电磁设备的旋转轴上，所述的旋转电磁设备固接在基座(1)上；所述的控制单元(4)包括驱动电路(31)和控制器(32);所述的旋转电磁设备通过驱动电路与控制器的信号输出端相连；所述的控制器通过驱动电路控制旋转电磁设备实现惯性测量单元的旋转运动；所述惯性测量单元的输出端通过信号线和计算单元的输入端相连，所述的计算单元获取惯性测量单元采集的运动信号并做实时计算。【文档编号】G01C21/16GK103712622SQ201310750475【公开日】2014年4月9日 申请日期:2013年12月31日 优先权日:2013年12月31日 【专利技术者】吴哲明, 孙振国, 张文增, 陈强 申请人:清华大学本文档来自技高网...

【技术保护点】
一种基于惯性测量单元旋转的陀螺漂移估计补偿方法，其特征在于该方法包括以下步骤：1)通过惯性测量单元所集成的陀螺仪和加速度计测量角速率和加速度；通过陀螺仪测量的角速率计算时间间隔Δt内惯性测量单元的倾角的变化数值ΔφΔθg:ΔφΔθg=sinφtanθ1-cosφtanθcosφ0-cosφsecθωxωyωzΔt---(1)式中ωxωyωz是陀螺仪测量得到的角速率，φ为横滚角，θ为俯仰角，ΔφΔθg为通过角速率计算的倾角变化值；2)通过加速度计测量的加速度利用公式（2）计算惯性测量单元的倾角，并获得时间间隔Δt内倾角变化ΔφΔθa:φθ=atan2(-Amx,-Amz)arcsin(Amy||Am||)---(2)3)式中是Amx、Amy、Amz分别为三轴加速度计测量的加速度，Am=[Amx??Amy??Amz]，ΔφΔθa为通过加速度计算的倾角变化值；4)计算2）获得的倾角变化ΔφΔθg和3）获得的倾角变化ΔφΔθa的差值r：r=ΔφΔθg-ΔφΔθa---(3)5)确定横滚角为φ、俯仰角为θ时倾角变化的差值r和陀螺漂移b的数学关系式：r=Vb???(4)式中，V=sinφtanθ1-cosφtanθsinφsecθ0cosφsecθ;6)控制惯性测量单元旋转，旋转轴方向的单位向量为u，旋转角度为Δα，旋转后的新姿态下的横滚角为φ′、俯仰角为θ′；7)重复步骤1)～5)，确定横滚角为φ′、俯仰角为θ′时倾角变化的差值r’和陀螺漂移b的数学关系式：r′=V′b???(5)式中，V′=sinφ′tanθ′1-cosφ′tanθ′sinφ′secθ′0cosφ′secθ′;8)联立旋转前后不同姿态下的数学关系式，通过最小二乘法计算陀螺仪的漂移并补偿陀螺仪角速率，输出校正后的姿态测量结果。...

【技术特征摘要】

【专利技术属性】
技术研发人员：吴哲明，孙振国，张文增，陈强，
申请(专利权)人：清华大学，
类型：发明
国别省市：