Fixed plank
Sending of position and orientation updates (correct yaw, broken pitch)