Todo List

File main.cpp

Add a seperate testclass

File NavigationCtrl.cpp

Write a function for positionupdates and don't scatter it all over the states

Member NavigationCtrl::doAction_gateway ()

Refactoring so it only checks the neares sector and does not relay on startsector

File VehicleCtrl.h

Change pSorticPark[] array so its dynamic size

Make a extra state after substate "checkposition" til "check if in pos" and use it in load and unload to minimize minimize code duplication

Stop the vehicle if connection with mqtt-broker is lost.