Final system for accurate AGV motion planning

Summary
In this report we will describe the final approach and system of the high-precision motion planner including the final integration approach with the qualitative planner of task T3.4.