This is the inital step to support torque/velocity/position control
For now, only open-loop velocity control is supported.