test
Dependencies: HMC6352 PID mbed
Fork of ver1_2_2 by
ultrasonic.cpp
- Committer:
- akudohune
- Date:
- 2013-03-10
- Revision:
- 1:89408fff7cc9
- Parent:
- 0:74bf4953c0d1
File content as of revision 1:89408fff7cc9:
#include "mbed.h" #include "ultrasonic.h" extern Timer timer2; extern Serial pc; // tx, rx double ultrasonicVal[ALL_ULTRASONIC] = {0}; void Ultrasonic() { for(uint8_t i = 0 ; i < ALL_ULTRASONIC ; i++){ uint8_t flag = 0; DigitalOut PingPinOut(ultrasonic_pin[i]); PingPinOut = 1; wait_us(10); PingPinOut = 0; DigitalIn PingPin(ultrasonic_pin[i]); timer2.reset(); while(PingPin == 0){ if(timer2.read_us() > 1000){ //1ms以上応答なし ultrasonicVal[i] = PING_ERR; flag = 1; break; } } timer2.reset(); while(PingPin == 1){ if((timer2.read_us() > 18500) || (flag == 1)){ //18.5ms以上のパルス ultrasonicVal[i] = PING_ERR; flag = 1; break; } } if(flag == 0){ ultrasonicVal[i] = timer2.read_us() / 1000000.0 / 2.0 * 340.0 * 1000.0; //cm } } //pc.printf("%f\n",ultrasonicVal[0] + ultrasonicVal[2]); //pc.printf("compass.sample = %f\n",compass.sample() / 1.0); }