Fixed mapping function and scope

Fixed the mapping function for positions and corrected scope issue
with wall cells.
Refactored some code
Added wall code to the main file

Added code to add walls to our nav map