- Correct MAG initialization
- correct gyro scaling
- more adjustment for new quad