re-orginasation

src/C++/Driver/src/main.cpp

@@ -1,18 +1,28 @@
-#include "CKobuki.h"
 #include <iostream>
 #include <cmath>
 #include <thread>
-#include "graph.h"
+#include "KobukiDriver/graph.h"
+#include "MQTT/MqttClient.h"
+#include "KobukiDriver/CKobuki.h"
+
 
 using namespace std;
 CKobuki robot;
 int movement();
 int checkCenterCliff();
 
-int main()
-{
+void setup(){
 	unsigned char *null_ptr(0);
 	robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
+	MqttClient client("mqtt://localhost:1883", "raspberry_pi_client", "ishak", "kobuki");
+    client.connect();
+    client.subscribe("home/commands");
+
+}
+
+int main()
+{
+
 	// thread mv(movement);
 	// mv.join(); //only exit once thread one is done running