robot.movej("park", sync=True)
robot.movej("home", sync=True)
robot.movel("park", sync=True)
robot.movel("home", sync=True)
robot.movec("p1","park", sync=True)
robot.movec("p1","home", sync=True)