void StopWheels() { if (spinFastNow) { printf(">>> StopWheels\n"); Log(LOG_STOP, 0, 0); spinFastNow = false; #ifdef HAVE_TOP_WHEEL #ifdef HAVE_TOP_CAN1 jagStop(topWheel1); Log(LOG_MODE, 1, 0); #endif #ifdef HAVE_TOP_PWM1 topWheel1->Disable(); Log(LOG_MODE, 1, 0); #endif #ifdef HAVE_TOP_CAN2 jagStop(topWheel2); Log(LOG_MODE, 2, 0); #endif #endif #ifdef HAVE_BOTTOM_WHEEL #ifdef HAVE_BOTTOM_CAN1 jagStop(bottomWheel1); Log(LOG_MODE, 3, 0); #endif #ifdef HAVE_BOTTOM_PWM1 bottomWheel1->Disable(); Log(LOG_MODE, 3, 0); #endif #ifdef HAVE_BOTTOM_CAN2 jagStop(bottomWheel2); Log(LOG_MODE, 4, 0); #endif #endif topPID = bottomPID = false; printf("<<< StopWheels\n"); } }