Lots of improvements
Implemented coordinate logging
Capturing the initial coordinates so we'll be able to check if a robot goes off the grid at any time.