pathfindingDONE!!

should work perfect havent tried yet
updated map with blocked property for red blocks