moved commander to C++, preparation for better gyro scale calibration respecting the current attitude for more accurate results