Casper Thomsen
/
UltrasonicCasper
Riiis
Fork of Ultrasonic by
main.cpp
- Committer:
- CTxD
- Date:
- 2015-04-10
- Revision:
- 2:39179781a18c
- Parent:
- 1:a8d4271903ac
File content as of revision 2:39179781a18c:
#include "mbed.h" #include "HCSR04.h" // Set's the Serial port Serial pc(USBTX, USBRX); // Defines the LED colors DigitalOut led(LED_RED); DigitalOut led2(LED_GREEN); // Defines the sensors (Left and Right) HCSR04 sensorLEFT(PTA12, PTD4); HCSR04 sensorRIGHT(PTA4, PTA5); // Get the left distance variable int distLeft(int dLEFT){ return dLEFT; } // Get the right distance variable int distRight(int dRIGHT){ return dRIGHT; } // The main() function int main() { // The loop() function while(1) { //left and right distance variables int dLEFT = sensorLEFT.distance(CM); int dRIGHT = sensorRIGHT.distance(CM); // Writes the left and right distance variable pc.printf("SENSOR Left: %d \n\r\v",distLeft(dLEFT)); pc.printf("SENSOR Right: %d \n\r\v",distRight(dRIGHT)); // Delay wait(0.5); //LED control if(dRIGHT<=10) { led = 0; led2 = 1; } if(dRIGHT>=40) { led2 = 0; led = 1; } if(dRIGHT>=11 && dRIGHT<=39) { led2 = 0; led=0; } } }