Geschwindigkeitesregelung durch den Ultraschallsensor

Dependencies:   BertlLib bertl_libraries mbed

Revision:
0:9ff985002d48
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Apr 25 06:58:09 2016 +0000
@@ -0,0 +1,31 @@
+#include "mbed.h"
+#include "Bertl14.h"
+#include "BertlObjects.h"
+#include "class_hardware.h"
+#include "pins_bertl.h"
+
+
+BusOut boardPow(PW_MOT, PW_IR, PW_ENC);
+
+Motor m_right(MR_PWM, MR_FWD, MR_REV);
+Motor m_left(ML_PWM, ML_FWD, ML_REV);
+
+USSensor usens(US_T,US_E);
+
+int main() {
+    boardPow=3;
+    InitBertl();
+    pex.useISR=0; leds=9;
+    pex.ClearLeds();
+    pex.WaitUntilButtonPressed();
+    pex.WaitUntilButtonPressed();
+    usens.initialize();
+    while(1) {
+        
+        int speed = ( usens.distance_mm - 80 ) * 1;
+        
+        m_left.set(speed);
+        m_right.set(speed);
+        
+    }
+}