Subversion Repositories Projects

Rev

Rev 759 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 759 Rev 765
Line 27... Line 27...
27 
#define FM_ADDRESS 10 // FOLLOW ME
 27 
#define FM_ADDRESS 10 // FOLLOW ME
Line 28... Line 28...
28 
 
 28 
 
29 
#define FALSE   0
 29 
#define FALSE   0
Line -... Line 30...
- 
 
 30 
#define TRUE    1
Line 30... Line 31...
30 
#define TRUE    1
 31 
 
31 
 
 32 
#define ABO_TIMEOUT 4000 // disable abo after 4 seconds
32 
 
 33 
 
33 
//int8_t test __attribute__ ((section (".noinit")));
 34 
//int8_t test __attribute__ ((section (".noinit")));
34 
uint8_t Request_VerInfo                 = FALSE;
 35 
uint8_t Request_VerInfo                 = FALSE;
35 
uint8_t Request_Display                 = FALSE;
 36 
uint8_t Request_Display                 = FALSE;
36 
uint8_t Request_Display1                = FALSE;
 37 
uint8_t Request_Display1                = FALSE;
37 
uint8_t Request_ExternalControl = FALSE;
 38 
uint8_t Request_ExternalControl = FALSE;
38 
uint8_t Request_DebugData               = FALSE;
 39 
uint8_t Request_DebugData               = FALSE;
- 
 
 40 
uint8_t Request_DebugLabel              = 255;
Line 39... Line 41...
39 
uint8_t Request_DebugLabel              = 255;
 41 
uint8_t Request_SendFollowMe    = FALSE;
40 
uint8_t Request_SendFollowMe    = FALSE;
 42 
uint8_t DisplayLine = 0;
41 
uint8_t DisplayLine = 0;
 43 
uint8_t DisplayKeys = 0;
42 
 
 44 
 
43 
volatile uint8_t txd_buffer[TXD_BUFFER_LEN];
 45 
volatile uint8_t txd_buffer[TXD_BUFFER_LEN];
44 
volatile uint8_t rxd_buffer_locked = FALSE;
 46 
volatile uint8_t rxd_buffer_locked = FALSE;
45 
volatile uint8_t rxd_buffer[RXD_BUFFER_LEN];
 47 
volatile uint8_t rxd_buffer[RXD_BUFFER_LEN];
Line 46... Line 48...
46 
volatile uint8_t txd_complete = TRUE;
 48 
volatile uint8_t txd_complete = TRUE;
- 
 
 49 
volatile uint8_t ReceivedBytes = 0;
Line 47... Line 50...
47 
volatile uint8_t ReceivedBytes = 0;
 50 
volatile uint8_t *pRxData = 0;
48 
volatile uint8_t *pRxData = 0;
 51 
volatile uint8_t RxDataLen = 0;
49 
volatile uint8_t RxDataLen = 0;
 52 
 
Line 50... Line 53...
50 
 
 53 
uint8_t PcAccess = 100;
51 
uint8_t PcAccess = 100;
 54 
uint16_t AboTimeOut = 0;
52 
 
 55 
 
53 
ExternControl_t ExternControl;
 56 
ExternControl_t ExternControl;
Line 54... Line 57...
54 
DebugOut_t              DebugOut;
 57 
DebugOut_t              DebugOut;
Line 55... Line 58...
55 
UART_VersionInfo_t      UART_VersionInfo;
 58 
UART_VersionInfo_t      UART_VersionInfo;
56 
 
 59 
 
Line 426... Line 429...
426 
                                        PcAccess = 255;
 429 
                                        PcAccess = 255;
427 
                                        break;
 430 
                                        break;
Line 428... Line 431...
428 
 
 431 
 
429 
                                case 'h':// request for display columns
 432 
                                case 'h':// request for display columns
430 
                                        PcAccess = 255;
 433 
                                        PcAccess = 255;
431 
                                        if((pRxData[0] & 0x80) == 0x00) // old format
 434 
                                        if((pRxData[0] & 0x80) == 0x00) // old format
432 
                                        {
 435 
                                        {
433 
                                                DisplayLine = 2;
 436 
                                                DisplayLine = 2;
434 
                                                Display_Interval = 0;
 437 
                                                Display_Interval = 0;
435 
                                        }
 438 
                                        }
436 
                                        else // new format
 439 
                                        else // new format
437 
                                        {
 440 
                                        {
438 
                                                RemoteKeys |= ~pRxData[0];
 441 
                                                DisplayKeys |= ~pRxData[0];
439 
                                                Display_Interval = (unsigned int)pRxData[1] * 10;
 442 
                                                Display_Interval = (uint16_t) pRxData[1] * 10;
440 
                                                DisplayLine = 4;
 443 
                                                DisplayLine = 4;
441 
                                                Request_Display = TRUE;
 444 
                                                AboTimeOut = SetDelay(ABO_TIMEOUT);
- 
 
 445 
                                        }
442 
                                        }
 446 
                                        Request_Display = TRUE;
Line 443... Line 447...
443 
                                        break;
 447 
                                        break;
444 
 
 448 
 
445 
                                case 'l':// request for display columns
 449 
                                case 'l':// request for display columns
446 
                                        PcAccess = 255;
 450 
                                        PcAccess = 255;
447 
                                        MenuItem = pRxData[0];
 451 
                                        MenuItem = pRxData[0];
Line 448... Line 452...
448 
                                        Request_Display1 = TRUE;
 452 
                                        Request_Display1 = TRUE;
449 
                                        break;
 453 
                                break;
450 
 
 454 
 
Line 451... Line 455...
451 
                                case 'v': // request for version and board release
 455 
                                case 'v': // request for version and board release
452 
                                        Request_VerInfo = TRUE;
 456 
                                        Request_VerInfo = TRUE;
453 
                                        break;
 457 
                                        break;
- 
 
 458 
 
454 
 
 459 
                                case 'd': // request for the debug data
Line 455... Line 460...
455 
                                case 'd': // request for the debug data
 460 
                                        DebugData_Interval = (uint16_t) pRxData[0] * 10;
456 
                                        DebugData_Interval = (uint16_t) pRxData[0] * 10;
 461 
                                        if(DebugData_Interval > 0) Request_DebugData = TRUE;
457 
                                        if(DebugData_Interval > 0) Request_DebugData = TRUE;
 462 
                                        AboTimeOut = SetDelay(ABO_TIMEOUT);
Line 491... Line 496...
491 
//---------------------------------------------------------------------------------------------
 496 
//---------------------------------------------------------------------------------------------
492 
void USART0_TransmitTxData(void)
 497 
void USART0_TransmitTxData(void)
493 
{
 498 
{
494 
        if(!txd_complete) return;
 499 
        if(!txd_complete) return;
Line -... Line 500...
- 
 
 500 
 
- 
 
 501 
        if(CheckDelay(AboTimeOut))
- 
 
 502 
        {
- 
 
 503 
                Display_Interval = 0;
- 
 
 504 
                DebugData_Interval = 0;
- 
 
 505 
        }
495 
 
 506 
 
496 
        if(Request_VerInfo && txd_complete)
 507 
        if(Request_VerInfo && txd_complete)
497 
        {
 508 
        {
498 
                SendOutData('V', FM_ADDRESS, 1, (uint8_t *) &UART_VersionInfo, sizeof(UART_VersionInfo));
 509 
                SendOutData('V', FM_ADDRESS, 1, (uint8_t *) &UART_VersionInfo, sizeof(UART_VersionInfo));
499 
                Request_VerInfo = FALSE;
 510 
                Request_VerInfo = FALSE;
500 
        }
 511 
        }
501 
        if( ((Display_Interval && CheckDelay(Display_Timer)) || Request_Display) && txd_complete)
 512 
        else if( (((Display_Interval > 0) && CheckDelay(Display_Timer)) || Request_Display) && txd_complete)
502 
        {
 513 
        {
503 
                if(DisplayLine > 3)// new format
 514 
                if(DisplayLine > 3)// new format
- 
 
 515 
                {
504 
                {
 516 
                        Menu_Update(DisplayKeys);
505 
                        LCD_PrintMenu();
 517 
                        DisplayKeys = 0;
506 
                        SendOutData('H', FM_ADDRESS, 1, (uint8_t *)DisplayBuff, 80);
 518 
                        SendOutData('H', FC_ADDRESS, 1, (uint8_t *)DisplayBuff, sizeof(DisplayBuff));
507 
                }
 519 
                }
508 
                else // old format
 520 
                else // old format
509 
                {
 521 
                {
510 
                        LCD_printfxy(0,0,"!!! INCOMPATIBLE !!!");
 522 
                        LCD_printfxy(0,0,"!!! INCOMPATIBLE !!!");
511 
                        SendOutData('H', FC_ADDRESS, 2, &DisplayLine, sizeof(DisplayLine), (uint8_t *)DisplayBuff, 20);
 523 
                        SendOutData('H', FC_ADDRESS, 2, &DisplayLine, sizeof(DisplayLine), (uint8_t *)DisplayBuff, 20);
512 
                        if(DisplayLine++ > 3) DisplayLine = 0;
 524 
                        if(DisplayLine++ > 3) DisplayLine = 0;
513 
                }
 525 
                }
514 
                Display_Timer = SetDelay(Display_Interval);
 526 
                Display_Timer = SetDelay(Display_Interval);
515 
                Request_Display = FALSE;
 527 
                Request_Display = FALSE;
516 
        }
 528 
        }
517 
        if(Request_Display1 && txd_complete)
 529 
        else if(Request_Display1 && txd_complete)
518 
        {
 530 
        {
519 
                LCD_PrintMenu();
 531 
                Menu_Update(0);
520 
                SendOutData('L', FM_ADDRESS, 3, &MenuItem, sizeof(MenuItem), &MaxMenuItem, sizeof(MaxMenuItem), DisplayBuff, sizeof(DisplayBuff));
 532 
                SendOutData('L', FC_ADDRESS, 3, &MenuItem, sizeof(MenuItem), &MaxMenuItem, sizeof(MaxMenuItem), DisplayBuff, sizeof(DisplayBuff));
521 
                Request_Display1 = FALSE;
 533 
                Request_Display1 = FALSE;
522 
        }
 534 
        }
523 
        if(Request_DebugLabel != 0xFF) // Texte für die Analogdaten
 535 
        else if(Request_DebugLabel != 0xFF) // Texte für die Analogdaten
524 
        {
 536 
        {
525 
                uint8_t label[16]; // local sram buffer
 537 
                uint8_t label[16]; // local sram buffer
526 
                memcpy_P(label, ANALOG_LABEL[Request_DebugLabel], 16); // read lable from flash to sram buffer
 538 
                memcpy_P(label, ANALOG_LABEL[Request_DebugLabel], 16); // read lable from flash to sram buffer
527 
                SendOutData('A', FM_ADDRESS, 2, (uint8_t *) &Request_DebugLabel, sizeof(Request_DebugLabel), label, 16);
 539 
                SendOutData('A', FM_ADDRESS, 2, (uint8_t *) &Request_DebugLabel, sizeof(Request_DebugLabel), label, 16);
528 
                Request_DebugLabel = 0xFF;
 540 
                Request_DebugLabel = 0xFF;
529 
        }
 541 
        }
530 
        if(Request_ExternalControl && txd_complete)
 542 
        else if(Request_ExternalControl && txd_complete)
531 
        {
 543 
        {
532 
                SendOutData('G', FM_ADDRESS, 1,(uint8_t *) &ExternControl, sizeof(ExternControl));
 544 
                SendOutData('G', FM_ADDRESS, 1,(uint8_t *) &ExternControl, sizeof(ExternControl));
533 
                Request_ExternalControl = FALSE;
 545 
                Request_ExternalControl = FALSE;
534 
        }
 546 
        }
535 
        if( ((DebugData_Interval && CheckDelay(DebugData_Timer)) || Request_DebugData) && txd_complete)
 547 
        else if( (((DebugData_Interval > 0) && CheckDelay(DebugData_Timer)) || Request_DebugData) && txd_complete)
536 
        {
 548 
        {
537 
                SendOutData('D', FM_ADDRESS, 1,(uint8_t *) &DebugOut, sizeof(DebugOut));
 549 
                SendOutData('D', FM_ADDRESS, 1,(uint8_t *) &DebugOut, sizeof(DebugOut));
538 
                DebugData_Timer = SetDelay(DebugData_Interval);
 550 
                DebugData_Timer = SetDelay(DebugData_Interval);
539 
                Request_DebugData = FALSE;
 551 
                Request_DebugData = FALSE;
540 
    }
 552 
    }
541 
        if(Request_SendFollowMe && txd_complete)
 553 
        else if(Request_SendFollowMe && txd_complete)
542 
        {
 554 
        {
543 
                SendOutData('s', NC_ADDRESS, 1, (uint8_t *)&FollowMe, sizeof(FollowMe));
 555 
                SendOutData('s', NC_ADDRESS, 1, (uint8_t *)&FollowMe, sizeof(FollowMe));
544 
                FollowMe.Position.Status = PROCESSED;
 556 
                FollowMe.Position.Status = PROCESSED;
545 
                Request_SendFollowMe = FALSE;
 557 
                Request_SendFollowMe = FALSE;