Geometrically constrained path planning with Fast Marching Square | IEEE Conference Publication | IEEE Xplore