Path Constrained Robot Control