Made telemetry less depend on ins with state implementation
Updated the AHRS and INS of the ardrone2, alot cleaner.