Motor lock-up fix, added reset position command