diff --git a/guided_mrmp/tests/db_opt_data2.yaml b/guided_mrmp/tests/db_opt_data2.yaml
deleted file mode 100644
index 717569e7de1a3c48ccc2984d42d050dcd02db521..0000000000000000000000000000000000000000
--- a/guided_mrmp/tests/db_opt_data2.yaml
+++ /dev/null
@@ -1,342 +0,0 @@
-conflicts:
-- !!python/tuple
-  - &id004 !!python/object:guided_mrmp.utils.robot.Robot
-    color:
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - &id001 !!python/object/apply:numpy.dtype
-        args:
-        - i8
-        - false
-        - true
-        state: !!python/tuple
-        - 3
-        - <
-        - null
-        - null
-        - null
-        - -1
-        - -1
-        - 0
-      - !!binary |
-        SAAAAAAAAAA=
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id001
-      - !!binary |
-        LAAAAAAAAAA=
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id001
-      - !!binary |
-        IAAAAAAAAAA=
-    control: !!python/object/apply:numpy._core.multiarray._reconstruct
-      args:
-      - &id002 !!python/name:numpy.ndarray ''
-      - !!python/tuple
-        - 0
-      - !!binary |
-        Yg==
-      state: !!python/tuple
-      - 1
-      - !!python/tuple
-        - 2
-      - &id003 !!python/object/apply:numpy.dtype
-        args:
-        - f8
-        - false
-        - true
-        state: !!python/tuple
-        - 3
-        - <
-        - null
-        - null
-        - null
-        - -1
-        - -1
-        - 0
-      - false
-      - !!binary |
-        1+kylQCo8D/3P5anvj+wvw==
-    current_position: &id006 !!python/object/apply:numpy._core.multiarray._reconstruct
-      args:
-      - *id002
-      - !!python/tuple
-        - 0
-      - !!binary |
-        Yg==
-      state: !!python/tuple
-      - 1
-      - !!python/tuple
-        - 3
-      - *id003
-      - false
-      - !!binary |
-        1sPYurPeS0DPCzni9nxHQNSlwrGlUfc/
-    dynamics_model: !!python/object:guided_mrmp.utils.control.Roomba
-      max_acc: 5.0
-      max_d_acc: 3.0
-      max_d_steer: !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPshCUA=
-      max_speed: 10.0
-      max_steer: !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPshGUA=
-    goal:
-    - 60
-    - 80
-    - 0
-    h_history:
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPsh+T8=
-    label: 0
-    last_mpc_controls: null
-    last_mpc_trajectory: null
-    next_control: null
-    next_step: null
-    radius: 5
-    rrtpath:
-    - !!python/tuple
-      - 60
-      - 20
-    - !!python/tuple
-      - 57.98885186144628
-      - 75.492068163438
-    - !!python/tuple
-      - 60
-      - 80
-    start:
-    - 60
-    - 20
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPsh+T8=
-    target_v: 1.0
-    waypoints:
-    - - 60
-      - 57.98885186144628
-      - 60
-    - - 20
-      - 75.492068163438
-      - 80
-    x_history:
-    - 60
-    y_history:
-    - 20
-  - &id005 !!python/object:guided_mrmp.utils.robot.Robot
-    color:
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id001
-      - !!binary |
-        TwAAAAAAAAA=
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id001
-      - !!binary |
-        XAAAAAAAAAA=
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id001
-      - !!binary |
-        AAAAAAAAAAA=
-    control: !!python/object/apply:numpy._core.multiarray._reconstruct
-      args:
-      - *id002
-      - !!python/tuple
-        - 0
-      - !!binary |
-        Yg==
-      state: !!python/tuple
-      - 1
-      - !!python/tuple
-        - 2
-      - *id003
-      - false
-      - !!binary |
-        2B2A5YGs8D/38M7fa+E7Pw==
-    current_position: &id007 !!python/object/apply:numpy._core.multiarray._reconstruct
-      args:
-      - *id002
-      - !!python/tuple
-        - 0
-      - !!binary |
-        Yg==
-      state: !!python/tuple
-      - 1
-      - !!python/tuple
-        - 3
-      - *id003
-      - false
-      - !!binary |
-        znA7odPfUEClA26ZUq1KQPorVw2BVPq/
-    dynamics_model: !!python/object:guided_mrmp.utils.control.Roomba
-      max_acc: 5.0
-      max_d_acc: 3.0
-      max_d_steer: !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPshCUA=
-      max_speed: 10.0
-      max_steer: !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPshGUA=
-    goal:
-    - 65
-    - 20
-    - 0
-    h_history:
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPsh+b8=
-    label: 1
-    last_mpc_controls: null
-    last_mpc_trajectory: null
-    next_control: null
-    next_step: null
-    radius: 5
-    rrtpath:
-    - !!python/tuple
-      - 65
-      - 80
-    - !!python/tuple
-      - 65.0
-      - 60.0
-    - !!python/tuple
-      - 65.0
-      - 40.0
-    - !!python/tuple
-      - 65
-      - 20
-    start:
-    - 65
-    - 80
-    - !!python/object/apply:numpy._core.multiarray.scalar
-      - *id003
-      - !!binary |
-        GC1EVPsh+b8=
-    target_v: 1.0
-    waypoints:
-    - - 65
-      - 65.0
-      - 65.0
-      - 65
-    - - 80
-      - 60.0
-      - 40.0
-      - 20
-    x_history:
-    - 65
-    y_history:
-    - 80
-control_weight: 1
-dt: 0.5
-env: !!python/object:guided_mrmp.utils.environment.Env
-  boundary:
-  - - 0
-    - 100
-  - - 0
-    - 100
-  circle_obs: []
-  delta: 0.5
-  rect_obs: []
-goal_weight: 5
-goals:
-- !!python/object/apply:numpy._core.multiarray._reconstruct
-  args:
-  - *id002
-  - !!python/tuple
-    - 0
-  - !!binary |
-    Yg==
-  state: !!python/tuple
-  - 1
-  - !!python/tuple
-    - 2
-  - *id003
-  - false
-  - !!binary |
-    TGsdlaL+SUCrIqlD331KQA==
-- !!python/object/apply:numpy._core.multiarray._reconstruct
-  args:
-  - *id002
-  - !!python/tuple
-    - 0
-  - !!binary |
-    Yg==
-  state: !!python/tuple
-  - 1
-  - !!python/tuple
-    - 2
-  - *id003
-  - false
-  - !!binary |
-    k0t1NtJeUUDbojPFW/FHQA==
-next_desired_controls:
-- - !!python/object/apply:numpy._core.multiarray.scalar
-    - *id003
-    - !!binary |
-      sJ+nAQAA4D8=
-  - !!python/object/apply:numpy._core.multiarray.scalar
-    - *id003
-    - !!binary |
-      PrST2///3z8=
-- - !!python/object/apply:numpy._core.multiarray.scalar
-    - *id003
-    - !!binary |
-      GTq6HD//378=
-  - !!python/object/apply:numpy._core.multiarray.scalar
-    - *id003
-    - !!binary |
-      ZJGZB9DstT8=
-obstacle_weight: 10
-rad: 5
-rob_dist_weight: 50
-robots:
-- *id004
-- *id005
-starts:
-- *id006
-- *id007
-time_weight: 5
-trajectories:
-- !!python/object/apply:numpy._core.multiarray._reconstruct
-  args:
-  - *id002
-  - !!python/tuple
-    - 0
-  - !!binary |
-    Yg==
-  state: !!python/tuple
-  - 1
-  - !!python/tuple
-    - 2
-    - 11
-  - *id003
-  - false
-  - !!binary |
-    1sPYurPeS0D9KSbgPuZLQBXoKmtu7ktA1XvCdP32S0Bz9E1oq/9LQJLrGLVJCExA2nnP57gQTEBU
-    P8Sg3hhMQNcwSGWbIExAIkq9ZsonTEBDthALYy5MQM8LOeL2fEdAxwL96zi/R0Dotty5gABIQCcG
-    z0PmQEhAq0pCaKGASECvxh00vb9IQNT8Lbr1/UhApJpnCZo6SUDNmM0IdnRJQMZZer4FqklAt8IL
-    ZL7aSUA=
-- !!python/object/apply:numpy._core.multiarray._reconstruct
-  args:
-  - *id002
-  - !!python/tuple
-    - 0
-  - !!binary |
-    Yg==
-  state: !!python/tuple
-  - 1
-  - !!python/tuple
-    - 2
-    - 11
-  - *id003
-  - false
-  - !!binary |
-    znA7odPfUEDfxyyDjN1QQG0v1ucD0lBAcXgwpqzAUEB3DSC776xQQKlvdE8amVBAj6D82VKGUEBk
-    QgLu63RQQFM+spHDZFBAkYk1PIxVUEAYpnv78UZQQKUDbplSrUpA8vQCh49wSkBdwwiWAjZKQBeh
-    erUY/UlA27s4ziLFSUB8Ib1Iw41JQJN1xhQPV0lARYlfoZ0hSUBIGyPHj+5IQFTeES1Wv0hAzwLR
-    pHyUSEA=