Setup the working environment with UR5