Nonlinear Decoupled Motion-Stiffness Control and Collision Detection/Reaction for the VSA-II Variable Stiffness Device