Fixed initialization of PathSegmentActive UAVO.
Simplified PathSegmentActive UAVO usage.
[PathManager]: 1) Fixed timeout state not to spam the PathManagerStatus
UAVO
2) Handle path segments which are impossibly close together.
3) Overshoot test returns a value