just output 1250 to servo5 and it will go through lots of rotations
Includes parameters enabling a ground level magnetic anomaly to be modelled. TODO - add automatic setting of declination, inclination and field strength using WGS-84 position.
That model can be used to run compass and accelerometer calibration by rotating the vehicle through the servos channels.