Fixed the ordering of motor commands in the e-stop interrupt