|
|
@ -98,10 +98,10 @@ public: |
|
|
|
* @param prev_wp, previous position triplet |
|
|
|
* @param prev_wp, previous position triplet |
|
|
|
* @param target_acceptance_radius, current position triplet xy acceptance radius |
|
|
|
* @param target_acceptance_radius, current position triplet xy acceptance radius |
|
|
|
* @param closest_pt, closest point to the vehicle on the line previous-current position triplet |
|
|
|
* @param closest_pt, closest point to the vehicle on the line previous-current position triplet |
|
|
|
* @param |
|
|
|
* @param wp_type, current triplet type |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
void checkAvoidanceProgress(const matrix::Vector3f &pos, const matrix::Vector3f &prev_wp, |
|
|
|
void checkAvoidanceProgress(const matrix::Vector3f &pos, const matrix::Vector3f &prev_wp, |
|
|
|
float target_acceptance_radius, const matrix::Vector2f &closest_pt, const int wp_type); |
|
|
|
float target_acceptance_radius, const matrix::Vector2f &closest_pt, const int wp_type); |
|
|
|
|
|
|
|
|
|
|
|
private: |
|
|
|
private: |
|
|
|
|
|
|
|
|
|
|
|