Added coordinate draw function.
Track path with robot works.