Added subsurface class, created servo commands

Science/Science.ino

@@ -1,6 +1,7 @@
 #include "pinouts.h"
 #include "src/utils/BURT_utils.h"
 #include "src/science.pb.h"
+#include "DFRobot_SHT3x.h"
 
 #define SCIENCE_COMMAND_ID 0x43
 #define SCIENCE_DATA_ID 0x17
@@ -37,11 +38,14 @@ void setup() {
   pumps.setup();
   carousel.setup();
 
+  subSurface.setup();
+
   Serial.println("Initializing sensors...");
   co2.setup();
   tempHumidity.setup();
 
 	Serial.println("Science Subsystem ready.");
+
 }
 
 void loop() {

Science/pinouts.h

@@ -3,6 +3,7 @@
 #include "motor_pinouts.h"
 #include "src/scooper/scooper.h"
 #include "src/temp_humidity/temp_humidity.h"
+#include "src/subsurface/subsurface.h"
 #include "src/pumps/pumps.h"
 #include "src/carousel/carousel.h"
 #include "src/co2/co2_sensor.h"
@@ -15,6 +16,7 @@ const int servo2 = 33;
 const int co2_address = 105;
 
 Motors motors(scoopArmMotor, dirtCarouselMotor, dirtLinearMotor);
+SubSurfaceBox subSurface;
 Scooper scooper(scoopArmMotor, servo1);
 DirtCarousel carousel(dirtCarouselMotor, servo2);
 

Science/src/subsurface/subsurface.cpp

@@ -0,0 +1,15 @@
+#include "subsurface.h"
+
+const int ServoPIN = 25;
+const int openPOS = 90;
+const int closePOS = 150;
+
+void SubSurfaceBox::setup(){
+    subSurfaceServo.attach(ServoPIN);
+}
+void SubSurfaceBox::open(){
+    subSurfaceServo.write(openPOS);
+}
+void SubSurfaceBox::close(){
+    subSurfaceServo.write(closePOS); 
+}

Science/src/subsurface/subsurface.h

@@ -0,0 +1,16 @@
+#pragma once
+#include <Arduino.h>
+#include "Servo.h"
+
+
+class SubSurfaceBox {
+
+    private:
+      Servo subSurfaceServo;
+    public:
+
+      void setup();
+      void open();
+      void close();
+};
+

Science/src/temp_humidity/temp_humidity.h

@@ -1,7 +1,7 @@
 #pragma once
 
 #include <Arduino.h>
-#include "dfrobot/DFRobot_SHT3x.h"
+#include "DFRobot_SHT3x.h"
 
 class TempHumiditySensor {
   private: