Integration has begun !

IMU partially integrated (angles only, task blocking issue)
Cleanup of unused fields in data structures
Improved documentation
Drone state echo from zigbee task for debugging (testing to do)