Merge branch 'develop'

qcr · May 3, 2023 · f73c711 · f73c711
2 parents 142365e + 06c9c1a
commit f73c711
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/src/benchbot_robot_controller.py b/src/benchbot_robot_controller.py
@@ -253,7 +253,6 @@ def stop(self):
         if not self.is_running():
             print("\nController isn't running, so nothing to stop.")
             return True
-
         # Get the stop command
         cmd = self._replace_variables(self.config_robot['stop_cmd'])
 
@@ -566,6 +565,10 @@ def __next():
                 else:
                     self.stop()
                     self.state['selected_environment'] = self._env_next()
+                    self.instance.config_env = self.config['environments'][self.state['selected_environment']]
+                    if 'trajectory_pose_next' in self.state:
+                        del self.state['trajectory_pose_next']
+                        del self.state['trajectory_poses']
                     self.start()
                     success = True
                 return flask.jsonify({'next_success': success})