fix diagonal pathing around walls/doors