Rev 92 | Rev 152 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 92 | Rev 151 | ||
---|---|---|---|
Line 87... | Line 87... | ||
87 | WPList[i].Position.Longitude = 0; |
87 | WPList[i].Position.Longitude = 0; |
88 | WPList[i].Position.Altitude = 0; |
88 | WPList[i].Position.Altitude = 0; |
89 | WPList[i].Heading = -1; |
89 | WPList[i].Heading = -1; |
90 | WPList[i].ToleranceRadius = 0; // in meters, if the MK is within that range around the target, then the next target is triggered |
90 | WPList[i].ToleranceRadius = 0; // in meters, if the MK is within that range around the target, then the next target is triggered |
91 | WPList[i].HoldTime = 0; // in seconds, if the was once in the tolerance area around a WP, this time defines the delay before the next WP is triggered |
91 | WPList[i].HoldTime = 0; // in seconds, if the was once in the tolerance area around a WP, this time defines the delay before the next WP is triggered |
92 | WPList[i].Event_Flag = 0; // future implementation |
92 | WPList[i].Event_Flag = 0; // future implementation |
93 | } |
93 | } |
94 | return TRUE; |
94 | return TRUE; |
95 | } |
95 | } |
Line 96... | Line 96... | ||
96 | 96 | ||
Line 114... | Line 114... | ||
114 | 114 | ||
115 | // rewind to the begin of the list, and returns the first waypoint |
115 | // rewind to the begin of the list, and returns the first waypoint |
116 | Waypoint_t* WPList_Begin(void) |
116 | Waypoint_t* WPList_Begin(void) |
117 | { |
117 | { |
118 | WPIndex = 0; // reset list index |
118 | WPIndex = 0; // reset list index |
119 | NaviData.WaypointIndex = WPIndex; |
119 | NaviData.WaypointIndex = WPIndex + 1; |
120 | if(WPNumber > 0) return(&(WPList[WPIndex])); // if list is not empty return pointer to first waypoint in the list |
120 | if(WPNumber > 0) return(&(WPList[WPIndex])); // if list is not empty return pointer to first waypoint in the list |
Line 121... | Line 121... | ||
121 | else return NULL; // else return NULL |
121 | else return NULL; // else return NULL |
Line -... | Line 122... | ||
- | 122 | ||
- | 123 | } |
|
- | 124 | ||
- | 125 | // jump to the end of the list, and returns the last waypoint |
|
- | 126 | Waypoint_t* WPList_End(void) |
|
- | 127 | { |
|
- | 128 | if(WPNumber > 0) |
|
- | 129 | { |
|
- | 130 | NaviData.WaypointIndex = WPNumber; |
|
- | 131 | WPIndex = WPNumber - 1; |
|
- | 132 | return(&(WPList[WPIndex])); // if list is not empty return pointer to first waypoint in the list |
|
- | 133 | } |
|
- | 134 | else |
|
- | 135 | { |
|
- | 136 | return NULL; // else return NULL |
|
- | 137 | } |
|
122 | 138 | ||
123 | } |
139 | } |
124 | 140 | ||
125 | // returns a pointer to the next waypoint or NULL if the end of the list has been reached |
141 | // returns a pointer to the next waypoint or NULL if the end of the list has been reached |
126 | Waypoint_t* WPList_Next(void) |
142 | Waypoint_t* WPList_Next(void) |
127 | { |
143 | { |
128 | if((WPIndex + 1) < WPNumber) // if the next WPIndex exist |
144 | if((WPIndex + 1) < WPNumber) // if the next WPIndex exist |
129 | { |
145 | { |
130 | WPIndex++; // goto next |
146 | WPIndex++; // goto next |
131 | NaviData.WaypointIndex = WPIndex; |
147 | NaviData.WaypointIndex = WPIndex + 1; |
132 | return(&(WPList[WPIndex])); // return pointer to this waypoint |
148 | return(&(WPList[WPIndex])); // return pointer to this waypoint |