Motion Planning with FISS -- RAL/IROS 2022