Magneto fix tested and working

@OpenUAS Tested the whole day:

the only diff is in the wait time: 20ms seems too short for many ardrone... 40x 1ms works every time.

@gautierhattenberger 

If you could confirm it still works for you that would be kind.