Closed TrackerSB closed 5 years ago
Without recognising the goal area in any way the optimization results in a velocity of 0 since this produces a minimal size of drivable area namely the size of the car itself.
A simplified version may be sufficient. Check whether the car is able to reach the goal area within the given time steps and the having the given velocity.
A simplified version of the goal region constraint was added but is not fully functional. See #22.
Extend measuring validity by recognizing whether the last position of the ego vehicle is within the goal region.