Пример #1
0
    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");
	}
    }