Added another point motion
Changed initial location robot
Uncommented defines to use external ports to control