Dynamic Time Warp

[NicoBartholomai]

Update the global path to use dtw to compare the sample path and the global path to give a better estimate of how close the two paths are to the planner. This would fix the issue where a path that circles back on itself would look very close to the global path even though it is not.