matrix with numpy and utility functions for grids.
minor change about grid
converter from coordinates to grid otherwise
forces for multiple robots