Rev 776 | Rev 785 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 776 | Rev 784 | ||
---|---|---|---|
Line 525... | Line 525... | ||
525 | 525 | ||
526 | case 's':// new target position |
526 | case 's':// new target position |
527 | pPoint = (Point_t*)SerialMsg.pData; |
527 | pPoint = (Point_t*)SerialMsg.pData; |
528 | if(pPoint->Position.Status == NEWDATA) |
528 | if(pPoint->Position.Status == NEWDATA) |
- | 529 | { |
|
529 | { |
530 | u32 start = 0; |
530 | //if(!(FC.StatusFlags & FC_STATUS_FLY)) PointList_Clear(); // flush the list |
531 | //if(!(FC.StatusFlags & FC_STATUS_FLY)) PointList_Clear(); // flush the list |
531 | //pPoint->Index = 1; // must be one after empty list |
532 | //pPoint->Index = 1; // must be one after empty list |
532 | PointList_SetAt(pPoint); |
533 | PointList_SetAt(pPoint); |
533 | if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE); |
534 | if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE); |
534 | // GPS_pWaypoint = PointList_WPBegin(); // updates POI index |
- | |
- | 535 | // GPS_pWaypoint = PointList_WPBegin(); // updates POI index |
|
Line 535... | Line 536... | ||
535 | 536 | if(pPoint->Index) start = pPoint->Index-1; |
|
536 | 537 | ||
537 | if(CurrentlyFlyingWaypoints) |
538 | if(CurrentlyFlyingWaypoints) |
538 | { |
539 | { |
539 | GPS_pWaypoint = PointList_WPBegin(); |
540 | GPS_pWaypoint = PointList_WPBegin(start); |
540 | NewWaypointsReceived = 0; // Only an update |
541 | NewWaypointsReceived = 0; // Only an update |
541 | } |
542 | } |
542 | BeepTime = 50; |
543 | BeepTime = 50; |
Line 600... | Line 601... | ||
600 | pPoint = (Point_t*)SerialMsg.pData; |
601 | pPoint = (Point_t*)SerialMsg.pData; |
601 | UART1_AboTimeOut = SetDelay(ABO_TIMEOUT); |
602 | UART1_AboTimeOut = SetDelay(ABO_TIMEOUT); |
602 | if((pPoint->Position.Status == INVALID) && (pPoint->Index == 0)) |
603 | if((pPoint->Position.Status == INVALID) && (pPoint->Index == 0)) |
603 | { |
604 | { |
604 | PointList_Clear(); |
605 | PointList_Clear(); |
605 | GPS_pWaypoint = PointList_WPBegin(); |
606 | GPS_pWaypoint = PointList_WPBegin(0); |
606 | UART1_Request_WritePoint = 0; // return new point count |
607 | UART1_Request_WritePoint = 0; // return new point count |
607 | NewWaypointsReceived = 1; |
608 | NewWaypointsReceived = 1; |
608 | } |
609 | } |
609 | else |
610 | else |
610 | { // update WP in list at index |
611 | { // update WP in list at index |