Add first version of motor control server