Removed forgotten line for debugging
Grid size is 5x5 and not 4x4
Fixed test