See JasperTanMsCSlides.pdf for information of how this works. Detailed readme soon.
All the code for path planning to support the EM project in SwissCat+