Refactoring to allow for variable grid sizes

Main purpose was to simplify the physical testing by
reducing the size of the grid to 3x3 rather than 7x7.
Peoon size was also reduced to fit within grid.