Added a Graph datastructure and refactored the Line/Vertex classes

src/SLAM.java

@@ -1,3 +1,4 @@
+import Vector.*;
 import processing.core.*;
 
 import java.util.ArrayList;
@@ -99,10 +100,4 @@ public class SLAM{
 
     }
 
-    public void drawLines(){
-        for(Line line : lines){
-            line.draw(proc);
-        }
-    }
-
 }