Stick some BLE in ME.
Dependencies: TB6612FNG mbed BLE_nRF8001
main.cpp@0:4277bfabef0d, 2014-11-06 (annotated)
- Committer:
- ddrew73
- Date:
- Thu Nov 06 22:36:36 2014 +0000
- Revision:
- 0:4277bfabef0d
- Child:
- 1:4e2578e8c73c
A gift from me to you.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ddrew73 | 0:4277bfabef0d | 1 | #include "mbed.h" |
ddrew73 | 0:4277bfabef0d | 2 | #include "TB6612.h" |
ddrew73 | 0:4277bfabef0d | 3 | |
ddrew73 | 0:4277bfabef0d | 4 | DigitalOut led1(LED1); |
ddrew73 | 0:4277bfabef0d | 5 | DigitalOut led2(LED2); |
ddrew73 | 0:4277bfabef0d | 6 | DigitalOut ultra_trigger(D8); |
ddrew73 | 0:4277bfabef0d | 7 | AnalogIn ultra_out(A0); |
ddrew73 | 0:4277bfabef0d | 8 | Serial pc(USBTX, USBRX); // tx, rx |
ddrew73 | 0:4277bfabef0d | 9 | |
ddrew73 | 0:4277bfabef0d | 10 | |
ddrew73 | 0:4277bfabef0d | 11 | DigitalOut BIN2(D3); |
ddrew73 | 0:4277bfabef0d | 12 | DigitalOut BIN1(D4); |
ddrew73 | 0:4277bfabef0d | 13 | PwmOut PWMB(D6); |
ddrew73 | 0:4277bfabef0d | 14 | DigitalOut stdby(D9); |
ddrew73 | 0:4277bfabef0d | 15 | |
ddrew73 | 0:4277bfabef0d | 16 | TB6612 motorB(D6,D3,D4); // PWMA,AIN1,AIN2 |
ddrew73 | 0:4277bfabef0d | 17 | float distance = 0; |
ddrew73 | 0:4277bfabef0d | 18 | float raw = 0; |
ddrew73 | 0:4277bfabef0d | 19 | |
ddrew73 | 0:4277bfabef0d | 20 | int main(){ |
ddrew73 | 0:4277bfabef0d | 21 | led1 = 1; |
ddrew73 | 0:4277bfabef0d | 22 | led2 = 1; |
ddrew73 | 0:4277bfabef0d | 23 | ultra_trigger = 1; |
ddrew73 | 0:4277bfabef0d | 24 | motorB = 0.0; |
ddrew73 | 0:4277bfabef0d | 25 | stdby = 1; |
ddrew73 | 0:4277bfabef0d | 26 | while(true){ |
ddrew73 | 0:4277bfabef0d | 27 | |
ddrew73 | 0:4277bfabef0d | 28 | motorB = 0.0; |
ddrew73 | 0:4277bfabef0d | 29 | raw = ultra_out; |
ddrew73 | 0:4277bfabef0d | 30 | distance = (ultra_out * 5) / 0.0098 ; |
ddrew73 | 0:4277bfabef0d | 31 | pc.printf("%1.3f %1.3f \n", raw, distance); |
ddrew73 | 0:4277bfabef0d | 32 | |
ddrew73 | 0:4277bfabef0d | 33 | |
ddrew73 | 0:4277bfabef0d | 34 | if (distance < 10){ |
ddrew73 | 0:4277bfabef0d | 35 | motorB = 1.0; |
ddrew73 | 0:4277bfabef0d | 36 | } |
ddrew73 | 0:4277bfabef0d | 37 | wait(3); |
ddrew73 | 0:4277bfabef0d | 38 | } |
ddrew73 | 0:4277bfabef0d | 39 | |
ddrew73 | 0:4277bfabef0d | 40 | } |
ddrew73 | 0:4277bfabef0d | 41 | |
ddrew73 | 0:4277bfabef0d | 42 | |
ddrew73 | 0:4277bfabef0d | 43 | |
ddrew73 | 0:4277bfabef0d | 44 | |
ddrew73 | 0:4277bfabef0d | 45 | |
ddrew73 | 0:4277bfabef0d | 46 | |
ddrew73 | 0:4277bfabef0d | 47 |