3D robot formations planning with Fast Marching Square | IEEE Conference Publication | IEEE Xplore