diff --git a/ros2/src/robobin/robobin/graphs/graph.json b/ros2/src/robobin/robobin/graphs/graph.json
index 366d562a19b8b409ad0ea6a1c707c9c9dde9301c..eefd4ab188e80f0e38b6d6fc13e8f929f1be093c 100644
--- a/ros2/src/robobin/robobin/graphs/graph.json
+++ b/ros2/src/robobin/robobin/graphs/graph.json
@@ -4,17 +4,17 @@
     {
       "name": "A1",
       "x": 0,
-      "y": 679.6644325851731
+      "y": 679.239821315259
     },
     {
       "name": "A2",
-      "x": 1494.6523425668192,
-      "y": 270.3753835093378
+      "x": 1493.441338836379,
+      "y": 257.44028404139897
     },
     {
       "name": "A3",
-      "x": 654.6331415803372,
-      "y": -643.6187595025372
+      "x": 648.8116533491154,
+      "y": -648.3094967053953
     },
     {
       "name": "A4",
@@ -23,71 +23,23 @@
     },
     {
       "name": "Node5",
-      "x": 1236.6236937460499,
-      "y": 626.7463258673126
+      "x": 1148.6969606484506,
+      "y": 227.22069723814027
     },
     {
       "name": "Node6",
-      "x": 1107.6511394229492,
-      "y": 629.0992105697735
+      "x": 1287.102163768439,
+      "y": 217.49951543050804
     },
     {
       "name": "Node7",
-      "x": 989.6882286490039,
-      "y": 632.0535697027161
-    },
-    {
-      "name": "Node8",
-      "x": 852.7015730481008,
-      "y": 634.2968533672276
-    },
-    {
-      "name": "Node9",
-      "x": 772.232844496588,
-      "y": 606.6862811773619
-    },
-    {
-      "name": "Node10",
-      "x": 770.3371326786553,
-      "y": 484.69823277423563
-    },
-    {
-      "name": "Node11",
-      "x": 778.2777647183966,
-      "y": 377.3746984338545
-    },
-    {
-      "name": "Node12",
-      "x": 801.1366057323605,
-      "y": 251.90717195294604
-    },
-    {
-      "name": "Node13",
-      "x": 806.2419595959261,
-      "y": 173.777774140363
-    },
-    {
-      "name": "Node14",
-      "x": 908.4267516751775,
-      "y": 231.85001260197535
-    },
-    {
-      "name": "Node15",
-      "x": 1041.9927977615012,
-      "y": 226.94380866336803
-    },
-
+      "x": 1371.58797853352,
+      "y": 255.7025704210035
+    }
+  
   ],
   "connections": [
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
@@ -98,14 +50,6 @@
       false
     ],
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
@@ -116,14 +60,6 @@
       false
     ],
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
@@ -134,14 +70,6 @@
       false
     ],
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
@@ -159,14 +87,6 @@
       false,
       true,
       false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false
     ],
     [
@@ -177,169 +97,9 @@
       true,
       false,
       true,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false
     ],
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
@@ -350,14 +110,6 @@
       true
     ],
     [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
       false,
       false,
       false,
diff --git a/ros2/src/robobin/robobin/graphs/graph_1.json b/ros2/src/robobin/robobin/graphs/graph_1.json
new file mode 100644
index 0000000000000000000000000000000000000000..366d562a19b8b409ad0ea6a1c707c9c9dde9301c
--- /dev/null
+++ b/ros2/src/robobin/robobin/graphs/graph_1.json
@@ -0,0 +1,371 @@
+{
+  "name": "Lab 1 Extended",
+  "nodes": [
+    {
+      "name": "A1",
+      "x": 0,
+      "y": 679.6644325851731
+    },
+    {
+      "name": "A2",
+      "x": 1494.6523425668192,
+      "y": 270.3753835093378
+    },
+    {
+      "name": "A3",
+      "x": 654.6331415803372,
+      "y": -643.6187595025372
+    },
+    {
+      "name": "A4",
+      "x": 0,
+      "y": 0
+    },
+    {
+      "name": "Node5",
+      "x": 1236.6236937460499,
+      "y": 626.7463258673126
+    },
+    {
+      "name": "Node6",
+      "x": 1107.6511394229492,
+      "y": 629.0992105697735
+    },
+    {
+      "name": "Node7",
+      "x": 989.6882286490039,
+      "y": 632.0535697027161
+    },
+    {
+      "name": "Node8",
+      "x": 852.7015730481008,
+      "y": 634.2968533672276
+    },
+    {
+      "name": "Node9",
+      "x": 772.232844496588,
+      "y": 606.6862811773619
+    },
+    {
+      "name": "Node10",
+      "x": 770.3371326786553,
+      "y": 484.69823277423563
+    },
+    {
+      "name": "Node11",
+      "x": 778.2777647183966,
+      "y": 377.3746984338545
+    },
+    {
+      "name": "Node12",
+      "x": 801.1366057323605,
+      "y": 251.90717195294604
+    },
+    {
+      "name": "Node13",
+      "x": 806.2419595959261,
+      "y": 173.777774140363
+    },
+    {
+      "name": "Node14",
+      "x": 908.4267516751775,
+      "y": 231.85001260197535
+    },
+    {
+      "name": "Node15",
+      "x": 1041.9927977615012,
+      "y": 226.94380866336803
+    },
+
+  ],
+  "connections": [
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true,
+      false
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false,
+      true
+    ],
+    [
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      false,
+      true,
+      false
+    ]
+  ]
+}
\ No newline at end of file
diff --git a/ros2/src/robobin/robobin/graphs/graphpt2.json b/ros2/src/robobin/robobin/graphs/graphpt2.json
deleted file mode 100644
index eefd4ab188e80f0e38b6d6fc13e8f929f1be093c..0000000000000000000000000000000000000000
--- a/ros2/src/robobin/robobin/graphs/graphpt2.json
+++ /dev/null
@@ -1,123 +0,0 @@
-{
-  "name": "Lab 1 Extended",
-  "nodes": [
-    {
-      "name": "A1",
-      "x": 0,
-      "y": 679.239821315259
-    },
-    {
-      "name": "A2",
-      "x": 1493.441338836379,
-      "y": 257.44028404139897
-    },
-    {
-      "name": "A3",
-      "x": 648.8116533491154,
-      "y": -648.3094967053953
-    },
-    {
-      "name": "A4",
-      "x": 0,
-      "y": 0
-    },
-    {
-      "name": "Node5",
-      "x": 1148.6969606484506,
-      "y": 227.22069723814027
-    },
-    {
-      "name": "Node6",
-      "x": 1287.102163768439,
-      "y": 217.49951543050804
-    },
-    {
-      "name": "Node7",
-      "x": 1371.58797853352,
-      "y": 255.7025704210035
-    }
-  
-  ],
-  "connections": [
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true,
-      false
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false,
-      true
-    ],
-    [
-      false,
-      false,
-      false,
-      false,
-      false,
-      false,
-      true,
-      false
-    ]
-  ]
-}
\ No newline at end of file