Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Baro: show timing in baro test

This commit is contained in:
Andrew Tridgell 2011-12-28 21:43:52 +11:00
parent 669a129175
commit c448e85ed1
1 changed files with 7 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AP_Baro/examples/AP_Baro_BMP085_test/AP_Baro_BMP085_test.pde
View File

@ -36,6 +36,8 @@ void setup()
I2c.begin(); I2c.begin();
I2c.timeOut(20); I2c.timeOut(20);
//I2c.setSpeed(true);
isr_registry.init(); isr_registry.init();
scheduler.init(&isr_registry); scheduler.init(&isr_registry);
@ -44,7 +46,7 @@ void setup()
} }
Serial.println("initialisation complete."); delay(100); Serial.println("initialisation complete."); delay(100);
delay(1000); delay(1000);
timer = millis(); timer = micros();
} }
void loop() void loop()
@ -52,9 +54,10 @@ void loop()
float tmp_float; float tmp_float;
float Altitude; float Altitude;
if((millis()- timer) > 50){ if((micros()- timer) > 50000L){
timer = millis(); timer = micros();
APM_BMP085.read(); APM_BMP085.read();
unsigned long read_time = micros() - timer;
if (!APM_BMP085.healthy) { if (!APM_BMP085.healthy) {
Serial.println("not healthy"); Serial.println("not healthy");
return; return;
@ -68,6 +71,7 @@ void loop()
tmp_float = pow(tmp_float, 0.190295); tmp_float = pow(tmp_float, 0.190295);
Altitude = 44330 * (1.0 - tmp_float); Altitude = 44330 * (1.0 - tmp_float);
Serial.print(Altitude); Serial.print(Altitude);
Serial.printf(" t=%u", (unsigned)read_time);
Serial.println(); Serial.println();
} }
} }