fix the line algorithm. runs now on grid not on robot coordinates.