void SystemSetup(void) { IORegSetup(); // Setup.c #if defined(USE_TIMER) TimerRegSetup(); // Setup.c TimerSetup(); // Setup.c #endif #if (defined(USE_UART) || defined(USE_MU)) UartRegSetup(); // Setup.c UartSetup(); // Uart.c #endif #if defined(USE_EXINT) ExintRegSetup(); // Setup.c #endif #if defined(USE_PCINT) PcintRegSetup(); // Setup.c #endif #if defined(USE_EXINT) ExintSetup(); #endif #if defined(USE_PCINT) PcintSetup(); #endif #if defined(USE_ENCODER) EncoderSetup(); // Encoder.c #endif #if defined(USE_MU) MuSetup(); // Mu.c #endif #if defined(USE_MOTOR) MotorSetup(); // Motor.c #endif #if defined(USE_SERVO) ServoSetup(); // Servo.c #endif #if defined(USE_SAFETY) SafetySetup(); // Safety.c #endif }
task main() { ServoSetup(); //waitForStart(); StartTask(stage); StartTask(tube); StartTask(motion); StartTask(elevator); while(true) { motor[FR] = 0; motor[BR] = 0; motor[FL] = 0; motor[BL] = 0; motor[UR] = 0; motor[UL] = 0; } }