motors state publishing
camera servos teleop added