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);
     }
    
    }