Robot controller

Worked on path.