Added mfault condition return to motor_test().
Added motor_test() to debugging commands.