[发明专利]陀螺仪空间定位方法

说明书

技术领域

本发明涉及定位技术，特别涉及一种陀螺仪空间定位方法。

背景技术

目前，随着MEMS(微机电系统)技术在消费类电子产品中广泛的应用，涌现出许多新生电子产物，比如空中鼠标、模仿人体动作的游戏手柄等。陀螺仪与加速度传感器的结合，使得类似空中鼠标等产品成为现实。

现有的陀螺仪空间定位方法是采用陀螺仪定位方式，陀螺仪定位方式是基于角速度检测的原理而设计，通过一系列的运算，得到的定位位置是相对于上次定位的一个相对值。现有的陀螺仪空间定位方法虽然已经使得空中指向定位成为可能，但由于得到的定位位置只是相对于上次定位的一个相对值，指向性存在一定的偏差，当长时间偏差得不到补偿时，偏差就会在一定程度上进行累加，以至于操作的体验越来越差，在某些特定场合，它还不能完全满足需要。如图1所示，现有的陀螺仪空间定位方法，实际的定位点2同期望定位点存在有偏差。

比如，教学用的空中鼠标中，当教师需要指出屏幕上显示的教案的一部分，有可能鼠标的光标已经移到了待指定对象，而手的指向并没有指向该对象，而当手指向该对象后，光标又指向了其他的地方；又如，在射击游戏中，经常会觉得手的指向和射击的对象不一致，从而使用户的体验变差，常常需要有一个重新定位的处理(比如：通过按键触发定位等)。虽然通过在屏幕前放置一定的光源，通过用户手中设备上的摄像头拍摄前方的光点实现定位，这种方法实现的指向性好了许多，但设计复杂，系统需要几个部分组成，同时还要保证屏幕前光源的位置和角度，而且容易受到外界光源的影响，并且很难通过一般的手段进行滤除。

发明内容

本发明要解决的技术问题是提供一种陀螺仪空间定位方法，能够实现定位同指向的一致。

为解决上述技术问题，本发明的种陀螺仪空间定位方法，运动控制器件中固定有陀螺仪，其特征在于，运动控制器件中还固定有三轴磁传感器，或二轴磁传感器和加速度传感器，包括以下步骤；

一.定位系统初始化；

二.初始化完成后，采集陀螺仪原始数据；

三.进行定位算法，根据陀螺仪原始数据及上一定位点位置数据计算出运动控制器件目前定位点相对于上一定位点的相对位移；

四.采集获取三轴磁传感器，或二轴磁传感器和加速度传感器的数据；

五.利用三轴磁传感器，或二轴磁传感器和加速度传感器的组合得到的数据，计算出目前运动控制器件的俯仰角和平面指向角，获得运动控制器件当前定位点绝对位置的相对位移误差补偿量；

六.根据计算获得的相对位移误差补偿量，补偿步骤三得到的运动控制器件目前定位点相对于上一定位点的相对位移，获得运动控制器件当前定位点绝对位置数据。

本发明的陀螺仪空间定位方法，还保存步骤五获得的运动控制器件当前定位点绝对位置的相对位移误差补偿量，同以前保存的相对位移误差补偿量组成一相对位移误差补偿量曲线表，根据位移误差补偿量曲线表的相对位移误差补偿量变化规律，确定误差补偿量变化的趋势，计算产生出定位相对误差，作为对下次获得的陀螺仪原始数据进行数据修正的相对位移前端补偿数据，在对下次采集的陀螺仪原始数据进行定位算法之前，先对下次采集的陀螺仪原始数据进行数据修正，提前补偿相对位移误差，然后再根据进行数据修正后的陀螺仪原始数据及上一定位点位置数据进行定位算法。

本发明的陀螺仪空间定位方法，在利用陀螺仪的相对位置定位的基础上，通过引入磁传感器获得俯仰角和平面指向角(其中，俯仰角也可以通过加速度传感器获得)补偿由陀螺仪相对位移偏差引起的实际指向偏差，从而进行绝对位置定位，提高定位系统的指向性。还进一步通过一段时间的相对位移误差补偿量的变化，分析出位移误差补偿量变化的趋势，计算产生出定位相对误差，作为对下次采集的陀螺仪原始数据进行数据修正的相对位移前端补偿数据，对下次采集的陀螺仪数据进行数据修正，提前补偿陀螺仪的相对位移定位与三轴磁传感器(或二轴磁传感器和加速度传感器)绝对定位之间产生的差异(相对位移误差)，这样可以使相对定位的结果与绝对定位结果之间的偏差减小，这样在进行下次三轴磁传感器(或二轴磁传感器和加速度传感器)指向性补偿时，不会造成较大的跃变。

附图说明

下面结合附图及具体实施方式对本发明作进一步详细说明。

图1是现有的陀螺仪空间定位方法指向性存在一定的偏差示意图；

图2是本发明的陀螺仪空间定位方法一实施方式流程图；

图3是本发明的陀螺仪空间定位方法一实施方式磁传感器俯仰角和平面指向角补偿区域示意图；