Auto adds heroes, Gridnav tweak

Auto adds player's hero as units, and small tweak to the gridnav code.