Subversion Repositories NaviCtrl

Rev

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

Rev 160 Rev 162
Line 412... Line 412...
412 
                                                break;
 412 
                                                break;
413 
                                }
 413 
                                }
414 
                                break;
 414 
                                break;
Line 415... Line 415...
415 
 
 415 
 
- 
 
 416 
                        case 'w'://  Append Waypoint to List
- 
 
 417 
                           {
- 
 
 418 
                            static u8 oldIndex = 0x00;
416 
                        case 'w'://  Append Waypoint to List
 419 
                               
417 
                                pWaypoint = (Waypoint_t*)SerialMsg.pData;
 420 
                                pWaypoint = (Waypoint_t*)SerialMsg.pData;
418 
                                if(pWaypoint->Position.Status == INVALID)
 421 
                                if(pWaypoint->Position.Status == INVALID)
419 
                                {  // clear WP List
 422 
                                {  // clear WP List
- 
 
 423 
                                        WPList_Clear();
420 
                                        WPList_Clear();
 424 
                                        oldIndex = 0x00;
421 
                                        GPS_pWaypoint = WPList_Begin();
 425 
                                        GPS_pWaypoint = WPList_Begin();
- 
 
 426 
                                        //UART1_PutString("\r\nClear WP List\r\n");
422 
                                        //UART1_PutString("\r\nClear WP List\r\n");
 427 
                                        UART1_Request_NewWaypoint = TRUE;
423 
                                }
 428 
                                }
424 
                                else if (pWaypoint->Position.Status == NEWDATA)
 429 
                                else if (pWaypoint->Position.Status == NEWDATA)
- 
 
 430 
                                {  // app current WP to the list
- 
 
 431 
                                        if (pWaypoint->Index == oldIndex + 1)
425 
                                {  // app current WP to the list
 432 
                                        {
426 
                                        WPList_Append(pWaypoint);
 433 
                                          WPList_Append(pWaypoint);
- 
 
 434 
                                          BeepTime = 500;
- 
 
 435 
                                          oldIndex = pWaypoint->Index;
- 
 
 436 
                                          UART1_Request_NewWaypoint = TRUE;
- 
 
 437 
                                         }
- 
 
 438 
                                         
427 
                                        BeepTime = 500;
 439 
                                     sprintf(text, "\r\nAdd WP: Index= %d, oldIndex = %d\r\n", pWaypoint->Index, oldIndex);
428 
                                        //UART1_PutString("\r\nAdd WP to List\r\n");
 440 
                                         UART1_PutString(text);
429 
                                }
 441 
                                }
430 
                                UART1_Request_NewWaypoint = TRUE;
 442 
                           }
Line 431... Line 443...
431 
                                break;
 443 
                                break;
432 
 
 444 
 
433 
                        case 'x'://  Read Waypoint from List
 445 
                        case 'x'://  Read Waypoint from List