void Disabled (void) { debug("disable"); Dlf->StopMotor(); Dlb->StopMotor(); Drf->StopMotor(); Drb->StopMotor(); }