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); |