reworked goalpos to be adjacent to a box, not a box
fixed aStar to search for goal adjacent to box and merged some minor stuff