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.