Compass: current based compensation added
Copter: add current based compass compensation