Rev 152 | Rev 171 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 152 | Rev 159 | ||
---|---|---|---|
Line 586... | Line 586... | ||
586 | } |
586 | } |
587 | // EOF waypoint trigger logic |
587 | // EOF waypoint trigger logic |
Line 588... | Line 588... | ||
588 | 588 | ||
589 | if(GPS_pWaypoint != NULL) // Waypoint exist |
589 | if(GPS_pWaypoint != NULL) // Waypoint exist |
- | 590 | { |
|
- | 591 | // possible new data have been put into wp-list |
|
- | 592 | if(GPS_pWaypoint->Position.Status == NEWDATA) |
|
- | 593 | { |
|
- | 594 | WPTime = SetDelay(GPS_pWaypoint->HoldTime * 1000); // update hold time stamp |
|
- | 595 | NCFlags &= ~NC_FLAG_TARGET_REACHED; |
|
590 | { |
596 | } |
591 | // update the hold position |
597 | // update the hold position |
- | 598 | GPS_CopyPosition(&(GPSData.Position), &GPS_HoldPosition); |
|
592 | GPS_CopyPosition(&(GPSData.Position), &GPS_HoldPosition); |
599 | // set target to the waypoint |
- | 600 | GPS_pTargetPosition = &(GPS_pWaypoint->Position); |
|
593 | GPS_pTargetPosition = &(GPS_pWaypoint->Position); |
601 | // update target radius |
Line 594... | Line 602... | ||
594 | GPS_TargetRadius = (s32)(GPS_pWaypoint->ToleranceRadius) * 100L; |
602 | GPS_TargetRadius = (s32)(GPS_pWaypoint->ToleranceRadius) * 100L; |
595 | 603 | ||
596 | } |
604 | } |