Signed-off-by: Petro Karashchenko <petro.karashchenko@gmail.com>
This is the inital step to support torque/velocity/position control
For now, only open-loop velocity control is supported.