Changed how test_motors stops the program