Reworked GridNav/Map

Better process of elimination for colours.
Added Point variables for each block for better simulation (Makes code
much more cluttered though)
Added checks for grabBlockAtPoint and moveNextToBlock functions (Will do
nothing if point is invalid).
Profit values in path decision algorithm are now predefines in config.
Fixed diagonal point bug.
Allowed seen points to be passable (Otherwise unable to reach unknowns
when searching).