103,7 → 103,8 |
timer0_init(); |
timer2_init(); |
usart0_Init(); |
if(CPUType == ATMEGA644P) usart1_Init(); |
if (CPUType == ATMEGA644P) |
usart1_Init(); |
RC_Init(); |
analog_init(); |
I2C_init(); |
139,7 → 140,8 |
OUTPUT_SET(0,1); |
GRN_OFF; |
RED_ON; |
while(!CheckDelay(timer)); |
while (!CheckDelay(timer)) |
; |
|
timer = SetDelay(200); |
OUTPUT_SET(0,0); |
146,10 → 148,12 |
OUTPUT_SET(1,1); |
RED_OFF; |
GRN_ON; |
while(!CheckDelay(timer)); |
while (!CheckDelay(timer)) |
; |
|
timer = SetDelay(200); |
while(!CheckDelay(timer)); |
while (!CheckDelay(timer)) |
; |
OUTPUT_SET(1,0); |
|
twi_diagnostics(); |
201,7 → 205,8 |
beep(2000); |
|
printf("\n\rControl: "); |
if (staticParams.GlobalConfig & CFG_HEADING_HOLD) printf("HeadingHold"); |
if (staticParams.GlobalConfig & CFG_HEADING_HOLD) |
printf("HeadingHold"); |
else printf("Neutral (ACC-Mode)"); |
|
printf("\n\n\r"); |