Interactive Device Design
Stick some BLE in ME.
Dependencies: TB6612FNG mbed BLE_nRF8001
Diff: main.cpp
- Revision:
- 0:4277bfabef0d
- Child:
- 1:4e2578e8c73c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Thu Nov 06 22:36:36 2014 +0000
@@ -0,0 +1,47 @@
+#include "mbed.h"
+#include "TB6612.h"
+
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+DigitalOut ultra_trigger(D8);
+AnalogIn ultra_out(A0);
+Serial pc(USBTX, USBRX); // tx, rx
+
+
+DigitalOut BIN2(D3);
+DigitalOut BIN1(D4);
+PwmOut PWMB(D6);
+DigitalOut stdby(D9);
+
+TB6612 motorB(D6,D3,D4); // PWMA,AIN1,AIN2
+float distance = 0;
+float raw = 0;
+
+int main(){
+led1 = 1;
+led2 = 1;
+ultra_trigger = 1;
+motorB = 0.0;
+stdby = 1;
+while(true){
+
+motorB = 0.0;
+raw = ultra_out;
+distance = (ultra_out * 5) / 0.0098 ;
+pc.printf("%1.3f %1.3f \n", raw, distance);
+
+
+if (distance < 10){
+ motorB = 1.0;
+ }
+wait(3);
+ }
+
+ }
+
+
+
+
+
+
+