- Add `nonlcon` function that checks if position is on track
and not on or inside an obstacle
- Add `options` for `fmincon` to not specify constraint gradient,
but specify objective gradient
- Add parameter for number of track boundary points to use
around the closest point to current position when checking
if point is inside track polygon