1. 程式人生 > >體感手柄-陀螺儀定位平面位移

體感手柄-陀螺儀定位平面位移

主要記錄下體感手柄之陀螺儀計算平面移動位移:

√axisX+axisY+axisZ=Cgnd;

axisX:地磁場向量在感測器X軸上的分量

axisY:地磁場向量在感測器Y軸上的分量

axisZ:地磁場向量在感測器Z軸上的分量

Cgnd:地磁場向量目前作用於運動控制器件的磁場強度

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

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

定位初始化可以使用加速度和地磁進行校準處理。