Switch to scan mode on startup to deal with multi networks

.gitignore

@@ -3,3 +3,4 @@
 *.settings*
 /Release/
 /sloeber.ino.cpp
+/spec.d

GetIMU.cpp

@@ -15,15 +15,14 @@ void GetIMU::event(float * buffer) {
   bufferINTERNAL[9]=bno->orientationY;
   bufferINTERNAL[10]=bno->orientationX;
   bufferINTERNAL[11]=bno->orientationZ;
-  
+
 
 	for (int i = 0; i < NUM_IMU_VALUES; i++) {
 		buffer[i] = bufferINTERNAL[i];
 	}
-
-}
-bool GetIMU::loop() {
+  //print();
 }
+
 void GetIMU::setXPosition(float x){
 	bufferINTERNAL[12] =x;
 }

GetIMU.h

@@ -33,7 +33,7 @@ class GetIMU: public PacketEventAbstract {
 	// Buffer contains data from the packet cming in at the start of the function
 	// User data is written into the buffer to send it back
 	void event(float * buffer);
-	bool loop();
+
 	void startSensor(EasyBNO055_ESP * _bno);
 	void print();
 

MarcosFirmware.ino

@@ -34,19 +34,26 @@ void otherI2CUpdate(){
 }
 
 void setup() {
-  manager.setup();
+  manager.setupScan();
+  manager.startThread();
+  servos = new ServoServer();
+  while(manager.getState()!=Connected){
+    vTaskDelay(10); //sleep 10ms
+  }
+  Serial.println("Starting Firmware Setup after WiFi connection");
   sensor = new GetIMU();
 	bno.start(&otherI2CUpdate);
   sensor->startSensor(&bno);
   Serial.println("Loading with name: " + name[0]);
-  servos = new ServoServer();
+
   coms.attach(new NameCheckerServer(name));
   coms.attach((PacketEvent*)sensor);
   coms.attach((PacketEvent*)servos);
+  Serial.println("Starting Firmware Loop");
+
 }
 
 void loop() {
-  manager.loop();
   if(manager.getState()==Connected)
     coms.server();
 }

ServoServer.cpp

@@ -70,4 +70,5 @@ void ServoServer::event(float *buffer) {
     //if(value>0&& value<254)
     	servos[i]->write(constrain(value, 0, 180));
   }
+
 }