- Added sensor data to telemetry.
- Fixed issue with wrong gyro processing.
- Prepering to use magnetometer.