Now solves single robot maps
some more test maps