体感手柄-陀螺仪定位平面位移

主要记录下体感手柄之陀螺仪计算平面移动位移：

√axisX+axisY+axisZ=Cgnd;

axisX:地磁场向量在传感器X轴上的分量

axisY:地磁场向量在传感器Y轴上的分量

axisZ:地磁场向量在传感器Z轴上的分量

Cgnd：地磁场向量目前作用于运动控制器件的磁场强度

平面指向角a=arctan(axisY/axisX);

平面俯仰角b=arctan(axisZ/(√axisX^2+axisY^2))

定位初始化可以使用加速度和地磁进行校准处理。