Change mesh waypoints handling to new format (#645)
Change mesh waypoints handling to new format (#645)


RoboJackets/igvc-software,RoboJackets/igvc-software,RoboJackets/igvc-software,RoboJackets/igvc-software