Need to work the velocity loop tuning method next