[fix] ECEF correction

Maybe this can enter the master branch faster than the other ardrone stuff.
Freek van Tienen made this addition. I looked at it with C.de Wagter, it looked sort of good. But we are not really into the context of the state interface, so maybe someone with a better understanding can judge it?

Comments are welcome...