I wrote diagonal correction. It assumes the robot is oriented 45
degrees. I will go test it now.