#include <HCSR04.h>
#include <mbed.h>

DigitalOut myled1(LED1);
Serial pc(USBTX, USBRX); // tx, rx

DigitalOut FrontLight(D7);
DigitalOut RearLight(D8);
 

void CheckFrontStatus()
{
    HCSR04 _RangeFinder(D4,D6);
    if(_RangeFinder.distance(1) < 11)
    {
        FrontLight = true;
    }        
    else
        FrontLight = false;
}
void CheckRearStatus()
{
    HCSR04 _RangeFinder(D4,D5);
    if(_RangeFinder.distance(1) < 11)
    {
        RearLight = true;
    }        
    else
        RearLight = false;
}


int main() {
    pc.printf("Running\r\n");
   while(1) 
    {
        myled1 = !myled1; // hearbeat
        CheckFrontStatus();
        CheckRearStatus();
        wait(.5);
    }
}