Completed the first part of the coordinate system

We can track robot's coordinates.