First working GUI

4DrobotServer/4DrobotServer.ino

@@ -20,12 +20,17 @@
 
 #include <OneWire.h>
 #include <DallasTemperature.h>
-#include <Servo.h>
 
 //This file holds all the configurations
 // to be modified for deployment
 #include "4DrobotServer_config.h"
 
+#ifdef USE_STDSERVOLIB
+#include <Servo.h>
+#else
+#include <Adafruit_TiCoServo.h>
+#endif
+
 //This file holds all the global variables
 // it does not need to be modified
 #include "4DrobotServer_globalVars.h"
@@ -46,6 +51,8 @@ void setup() {
   Serial.print('\n');
   Serial.println(F("4DrobotServer initializing..."));
 
+  pinMode(emergency_stop_pin, INPUT_PULLUP);
+
   setup_networkIO();
 
   setup_servo();