update 结构

include/mpu.h

@@ -0,0 +1,2 @@
+void mpu_init();
+void mpu_loop();

include/temp.h

@@ -0,0 +1,2 @@
+void temp_init();
+void temp_loop();

src/main.cpp

@@ -2,49 +2,28 @@
 #include <protothreads.h>
 
 #include <bt.h>
+#include <mpu.h>
 #include <ping.h>
 #include <servo.h>
+#include <temp.h>
 #include <web.h>
 
 void setup() {
   Serial.begin(115200);
   servo_init();
-  // bt_init();
+  bt_init();
-  // web_init();
+  web_init();
   ping_init();
+  mpu_init();
+  temp_init();
 }
 
 void loop() {
   servo_loop();
-  // bt_loop();
+  bt_loop();
-  // web_loop();
+  web_loop();
   ping_loop();
-  String co = Serial.readString();
+  mpu_loop();
-  if (co.length() != 0) {
+  temp_loop();
-    int pin = co[0] - '0';
-    int m = co[1] - '0';
-    Serial.println(co);
-    switch (m) {
-      case 1:
-        servo_deg(pin, getpos(pin) + 15);
-        break;
-      case 2:
-        servo_deg(pin, getpos(pin) - 15);
-        break;
-      case 3:
-        servo_deg(0, 180);
-        delay(500);
-        servo_deg(1, 180);
-        delay(500);
-        servo_deg(2, 180);
-        delay(500);
-        servo_deg(3, 180);
-        delay(500);
-        break;
-      default:
-        servo_deg(pin, 90);
-        break;
-    }
-  }
   delay(100);
 }