fixes on walls vs grid cells, scaling of agents in rviz
minor refactoring and logic tuning