fix evacuate for second robot

src/moveit_sorting_controller.cpp

@@ -146,8 +146,8 @@ int main(int argc, char **argv)
 
       geometry_msgs::Pose pose;
       pose.orientation.x = 1;
-      pose.position.x = .2;
-      pose.position.z = 1.3;
+      pose.position.x = robot->pos().x() + .4;
+      pose.position.z = robot->pos().z() + .4;
       controller.moveToPose(*robot, pose, false);
 
     } else if (command.has_configchange()) {