Added motion controller
Added the motion stuff to the telemetry