v2.5.2

Fix bug for multiple environments (SCD)

1. Made sure that __next function would not just update the RobotController selected_environment state but update the ControllerInstance config_env parameter when changing environments.
2. Deleted RobotController trajectory_pose_next and trajectory_poses when changing environments