Ardrone2 magnetofixfix

A tested fix on four different ARdrone2's and for day on end to find a fix. Restyled to PPRZ codestyle with astyle script included with PPRZ that give a little more changes than normal.

Removed telemetry for now, since it hung after that inclusion several times, no clue why. If needed can be re-added after a renewed testing round.