Subversion Repositories NaviCtrl

Rev

Rev 767 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 767 Rev 803
Line 500... Line 500...
500 
/* Get Version Info from UBX Module                           */
 500 
/* Get Version Info from UBX Module                           */
501 
/**************************************************************/
 501 
/**************************************************************/
502 
u8 UART0_GetUBXVersion(void)
 502 
u8 UART0_GetUBXVersion(void)
503 
{
 503 
{
504 
        u32 timeout;
 504 
        u32 timeout;
505 
        u8 msg[64];
 505 
        u8 msg[220];
506 
        u8 retval = 0xFF;
 506 
        u8 retval = 0xFF;
507 
        u8 ubxmsg[]={0x0A, 0x04, 0x00, 0x00}; //MON-VER
 507 
        u8 ubxmsg[]={0x0A, 0x04, 0x00, 0x00}; //MON-VER
508 
        // prepare rx msg filter
 508 
        // prepare rx msg filter
509 
        UbxMsg.Hdr.Class = 0x0A;
 509 
        UbxMsg.Hdr.Class = 0x0A;
510 
        UbxMsg.Hdr.Id = 0x04;
 510 
        UbxMsg.Hdr.Id = 0x04;
Line 522... Line 522...
522 
        if((UbxMsg.Hdr.Length >= 40) && (UbxMsg.Status == NEWDATA))
 522 
        if((UbxMsg.Hdr.Length >= 40) && (UbxMsg.Status == NEWDATA))
523 
        {
 523 
        {
524 
        retval = UbxVersionParser();
 524 
        retval = UbxVersionParser();
525 
        if(retval != 0xff)
 525 
        if(retval != 0xff)
526 
         {
 526 
         {
- 
 
 527 
/*
- 
 
 528 
unsigned int i;
- 
 
 529 
for(i=0;i< sizeof(UbxMsg.Data);i++)
- 
 
 530 
 {
- 
 
 531 
  if(UbxMsg.Data[i] == 0) UbxMsg.Data[i] = '°';
- 
 
 532 
 }
- 
 
 533 
//UbxMsg.Data[30] = 0;
- 
 
 534 
UbxMsg.Data[sizeof(UbxMsg.Data)-1] = 0;
527 
                UbxMsg.Data[4] = 0; //Only the first 4 characters
535 
//              UbxMsg.Data[4] = 0; //Only the first 4 characters
- 
 
 536 
*/
- 
 
 537 
 
528 
                sprintf(msg, " V%d.%d SW:%s", retval/10,retval%10, (u8*)&UbxMsg.Data[0]);
 538 
                sprintf(msg, " V%d.%d (%d) SW:%s", retval/10,retval%10, GPS_Version, (u8*)&UbxMsg.Data[0]);
529 
                UART1_PutString(msg);
 539 
                UART1_PutString(msg);
- 
 
 540 
                sprintf(msg, "|%s|%s",(u8*)&UbxMsg.Data[40],(u8*)&UbxMsg.Data[40+30]);
- 
 
 541 
                UART1_PutString(msg);
- 
 
 542 
 
- 
 
 543 
        if(UbxMsg.Data[40+60])
- 
 
 544 
         {                                               
- 
 
 545 
                sprintf(msg, "\n\r                   %s|%s|%s",(u8*)&UbxMsg.Data[40+60],(u8*)&UbxMsg.Data[40+90],(u8*)&UbxMsg.Data[40+120]);
- 
 
 546 
                UART1_PutString(msg);
- 
 
 547 
         }
530 
        }
 548 
        }
531 
         else UART1_PutString(" ! -> UNKNOWN <- ! ");
 549 
         else UART1_PutString(" ! -> UNKNOWN <- ! ");
532 
        }
 550 
        }
533 
 UbxMsg.Status = INVALID;
 551 
 UbxMsg.Status = INVALID;
534 
 return(retval);
 552 
 return(retval);