Removed velocity commands and added position commands