Added two new arrays.

Lets me keep track of which cells will be done next by the mapping and cost calculating steps.