Fixed a bunch of bugs in Station Keeping.

Made the failsafe maneuver a lot more sensible: it just rides the closest tack if it can't reach the corner. It also adjusts sheets full speed until it reaches 15m above the bottom of the box.