Stick some BLE in ME.
Dependencies: TB6612FNG mbed BLE_nRF8001
main.cpp
- Committer:
- ddrew73
- Date:
- 2014-11-06
- Revision:
- 0:4277bfabef0d
- Child:
- 1:4e2578e8c73c
File content as of revision 0:4277bfabef0d:
#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); } }