Reject waypoints above surface of the water
DSsoto opened this issue · comments
Now that we will have the simulator's position being set by C3's waypoint, we should reject waypoints that go outside of the water. Right now I am able to make the sub fly.
It would be great if this was done in a way that we can reuse the code to reject waypoints behind walls once wall detection has been implemented.
Addressed by #242.