New class and code for part 4

include/motor_driver.h

@@ -11,6 +11,8 @@ public:
     void forward();
     void reverse();
     void stop();
+
+    void set(double pwm);
 };
 
 #endif

include/p_controller.h

@@ -0,0 +1,15 @@
+#ifndef P_CONTROLLER_H
+#define P_CONTROLLER_H
+
+class P_controller
+{
+private:
+    double Kp;
+
+public:
+    P_controller(double Kp);
+
+    double update(double ref, double actual);
+};
+
+#endif