Created libraries2
Dependencies: mbed ultrasonic
main.cpp
- Committer:
- VegardMidt
- Date:
- 2015-04-16
- Revision:
- 6:0d4008544238
- Parent:
- 5:b2df25183cb1
- Child:
- 7:c763b5d61dee
- Child:
- 8:454f1f82aca4
File content as of revision 6:0d4008544238:
#include "mbed.h" #include "ultrasonic.h" PwmOut TX1(D9); // Use pin D9 DigitalOut TX2(D8); // Use pin D8 DigitalOut HVoff(D6); // Use pin D6 InterruptIn signal(D7); // Use pin D7 Timeout to1; Timer t1; Serial pc(SERIAL_TX, SERIAL_RX); float previous = 1; void TX1_send(){ previous = 1; HVoff = 0; TX1.period(0.0000252); // Set the period of TX1 to 25.2us (39,682kHz) TX1.pulsewidth(0.0000116); // Set the pulsewidth of TX1 to 11.6us (ON) wait(0.0002016); // Waits 201.6us TX1 = 0; t1.reset(); HVoff = 1; to1.attach(TX1_send,0.1); // Sends for 1000us } void signal_reciev(){ float _time = t1.read(); if (_time<0.006 && _time>0.0007){ if (t1.read()>previous){ pc.printf("check"); } else{ previous = _time; float cm = 0; cm = 34613*_time/2; // Calculate distance pc.printf("%f\r\n", cm); // Prints distance } } } int main() { t1.start(); signal.fall(&signal_reciev); TX2 = 1; TX1_send(); while(1); }