msp: add servo command.

Signed-off-by: Daniel Stodden <daniel.stodden@gmail.com>
msp: add motor command.

Signed-off-by: Daniel Stodden <daniel.stodden@gmail.com>