This branch was started in order to add a service server for retrieving planned path without directly driving them (e.g. to compare which item to retrieve first). It developed into a refactoring branch to better isolate the planning routine. I will rename this merge request and pull it into the current
master. Then, I will start a follow-up merge request for finally adding this said service.