Finished. Added saving of actual position on grid point instead of always on center.

This is now considered finished as the results are the desired ones.
Maybe some clean up will come but no more development.