Rev 264 | Rev 275 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 264 | Rev 270 | ||
|---|---|---|---|
| Line 120... | Line 120... | ||
| 120 | 120 | ||
| 121 | //---------------------------------------------------------------------------------------------------- |
121 | //---------------------------------------------------------------------------------------------------- |
| 122 | void GetNaviCtrlVersion(void) |
122 | void GetNaviCtrlVersion(void) |
| 123 | { |
123 | { |
| 124 | u8 msg[25]; |
124 | u8 msg[25]; |
| 125 | 125 | ||
| 126 | sprintf(msg,"\n\r NaviCtrl HW: V%d.%d SW: V%d.%d%c", Version_HW/10, Version_HW%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH); |
126 | sprintf(msg,"\n\r NaviCtrl HW: V%d.%d SW: V%d.%d%c", Version_HW/10, Version_HW%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH); |
| 127 | UART1_PutString(msg); |
127 | UART1_PutString(msg); |
| Line 128... | Line 128... | ||
| 128 | } |
128 | } |
| Line 348... | Line 348... | ||
| 348 | GetNaviCtrlVersion(); |
348 | GetNaviCtrlVersion(); |
| 349 | DebugOut.Status[0] = 0x04 | 0x08; // NC and MK3Mag |
349 | DebugOut.Status[0] = 0x04 | 0x08; // NC and MK3Mag |
| 350 | DebugOut.Status[1] = 0x00; |
350 | DebugOut.Status[1] = 0x00; |
| Line 351... | Line 351... | ||
| 351 | 351 | ||
| 352 | Compass_Init(); |
352 | Compass_Init(); |
| 353 | 353 | ||
| 354 | SPI0_GetFlightCtrlVersion(); |
354 | SPI0_GetFlightCtrlVersion(); |
| 355 | if(FC_Version.Compatible != FC_SPI_COMPATIBLE) |
355 | if(FC_Version.Compatible != FC_SPI_COMPATIBLE) |
| 356 | { |
356 | { |
| 357 | UART1_PutString("\n\r Flight-Ctrl not compatible"); |
357 | UART1_PutString("\n\r Flight-Ctrl not compatible"); |
| 358 | LED_RED_ON; |
358 | LED_RED_ON; |
| Line 359... | Line 359... | ||
| 359 | } |
359 | } |
| Line 360... | Line 360... | ||
| 360 | 360 | ||
| 361 | GPS_Init(); |
361 | GPS_Init(); |
| 362 | 362 | ||
| 363 | // ---------- Prepare the isr driven |
363 | // ---------- Prepare the isr driven |
| 364 | // set to absolute lowest priority |
364 | // set to absolute lowest priority |
| Line 365... | Line 365... | ||
| 365 | VIC_Config(EXTIT3_ITLine, VIC_IRQ, PRIORITY_SW); |
365 | VIC_Config(EXTIT3_ITLine, VIC_IRQ, PRIORITY_SW); |
| 366 | // enable interrupts |
366 | // enable interrupts |
| 367 | VIC_ITCmd(EXTIT3_ITLine, ENABLE); |
367 | VIC_ITCmd(EXTIT3_ITLine, ENABLE); |
| 368 | 368 | ||
| 369 | Debug_OK("START"); |
369 | Debug_OK("START"); |
| 370 | 370 | ||
| 371 | for (;;) // the endless main loop |
371 | for (;;) // the endless main loop |