Rev 501 | Rev 503 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 501 | Rev 502 | ||
|---|---|---|---|
| Line 592... | Line 592... | ||
| 592 | PollingTimeout = 5; |
592 | PollingTimeout = 5; |
| 593 | Polling(); |
593 | Polling(); |
| 594 | // ++++++++++++++++++++++++++++++++++++++++++++++ |
594 | // ++++++++++++++++++++++++++++++++++++++++++++++ |
| 595 | if(FromFC_LoadWP_List) |
595 | if(FromFC_LoadWP_List) |
| 596 | { |
596 | { |
| 597 | //if(FromFC_LoadWP_List & 0x80) -> load relative |
- | |
| 598 | WPL_Store.Index = FromFC_LoadWP_List; |
597 | WPL_Store.Index = FromFC_LoadWP_List; |
| 599 | if(PointList_ReadFromFile(&WPL_Store) == WPL_OK) |
598 | if(PointList_ReadFromFile(&WPL_Store) == WPL_OK) |
| - | 599 | { |
|
| - | 600 | if(FromFC_LoadWP_List & 0x80)// -> load relative |
|
| - | 601 | { |
|
| - | 602 | if(!PointList_Move(1, &(GPSData.Position))) // try to move wp-list so that 1st entry matches the current position |
|
| 600 | { |
603 | { |
| - | 604 | PointList_Clear(); |
|
| - | 605 | } |
|
| - | 606 | } |
|
| 601 | if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE); |
607 | if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE); |
| 602 | GPS_pWaypoint = PointList_WPBegin(); // updates POI index |
608 | GPS_pWaypoint = PointList_WPBegin(); // updates POI index |
| 603 | BeepTime = 150; |
609 | BeepTime = 150; |
| 604 | } |
610 | } |
| 605 | FromFC_LoadWP_List = 0; |
611 | FromFC_LoadWP_List = 0; |
| 606 | } |
612 | } |
| 607 | // ++++++++++++++++++++++++++++++++++++++++++++++ |
613 | // ++++++++++++++++++++++++++++++++++++++++++++++ |
| Line 608... | Line 614... | ||
| 608 | 614 | ||
| 609 | // ---------------- Logging --------------------------------------- |
615 | // ---------------- Logging --------------------------------------- |