- Add max/min position limits
- Delete `eq_cons` function for now
- Update `bound_cons` to enforce limit and
max/min position limits
- Rename `nonlincon` to `road_obstacle_cons`
- Parameterize index search around closest
road boundary point in `road_obstacle_cons`