void main(void) { DisableInterrupts; PLL_Init_64M(); UART_Init(); Init_Port(); Init_AD(); Init_PWM(); // LCD_init(); // LCD_clear(); // RST = 1; PAT_Init(); // PWMDTY23 =6300 ; // DDRA_DDRA7 = 1; EnableInterrupts; for(;;) { Mode(); // uart_putchar('a'); /* OutData[0] = (int16)(roadflag[2]); OutData[1] = (int16)(roadflag[3]); OutData[2] = (int16)(Steer); OutData[3] = (int16)(roadflag[1]); OutPut_Data(); */ // Ramp_Detection(); GetExpectSpeed(); Steer_PID(); stop_car(); //Motor(1800); } }
void wait_until_message() { stop_car(); }