Motors and servos control

TBD