- fix bugs found by test
- Implemented Mock mission item protocol in

Plus lots of other cleanup

Handy for testing without a real board

Fully working waypoint interface, thoroughly tested. Active waypoint setting has to be debugged in the simulator, but works fine on real hardware

Working on better simulation implementation, fixed a bug where the port handle was not fully released