Move commands handled
- StabCtrl now init vars on thread start (m_fXXXCompensation & m_fGlobalMotorSpeed)
- Fixes on StabCtrl motor speed calculus
- Added functions control more precisely StabCtrl
- Added functions to rotate Vector3D around axis
Changed move angles & added sensibility to motor speed calculus