int main(void) { POWEROFF(); delayU(100); POWERUP(); lcd.setLineOne("Welcome to"); lcd.setLineTwo("TowerBuilder"); sei(); //Enable global interrupt while(1) { //Send 1 character to LCD if LCD is ready if(lcd.ready()) lcd.print(); //Task scheduler if(taskDone == FALSE) { switch(taskNumber++) { case 0: button.readButtons(); menu(); break; case 1: adc.convertPOT(); break; case 2: sensor.readSensors(); break; case 3: first(); break; case 4: break; case 5: break; case 6: break; default: taskNumber = 0; break; } taskDone = TRUE; //Update servo's channel after each task finished while(updateChannel == FALSE); servo.servoPWM(); updateChannel = FALSE; } } }