Added readArmStates, NEXT: Send a velocity command