Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-26 18:48:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

uncrustify libraries/AP_Airspeed/AP_Airspeed.cpp

Browse Source
This commit is contained in:
uncrustify 2012-08-16 23:08:43 -07:00 committed by Pat Hickey
parent 6c5f73fde4
commit 314b84f209
1 changed files with 27 additions and 27 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

54
libraries/AP_Airspeed/AP_Airspeed.cpp
View File

@ -1,12 +1,12 @@
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*- /// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
/* /*
APM_Airspeed.cpp - airspeed (pitot) driver * APM_Airspeed.cpp - airspeed (pitot) driver
*
This library is free software; you can redistribute it and/or * This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public License * modify it under the terms of the GNU Lesser General Public License
as published by the Free Software Foundation; either version 2.1 * as published by the Free Software Foundation; either version 2.1
of the License, or (at your option) any later version. * of the License, or (at your option) any later version.
*/ */
#include <FastSerial.h> #include <FastSerial.h>
#include <AP_Common.h> #include <AP_Common.h>
@ -47,29 +47,29 @@ const AP_Param::GroupInfo AP_Airspeed::var_info[] PROGMEM = {
// the get_airspeed() interface can be used // the get_airspeed() interface can be used
void AP_Airspeed::calibrate(void (*callback)(unsigned long t)) void AP_Airspeed::calibrate(void (*callback)(unsigned long t))
{ {
float sum = 0; float sum = 0;
uint8_t c; uint8_t c;
if (!_enable) { if (!_enable) {
return; return;
} }
_source->read(); _source->read();
for (c = 0; c < 10; c++) { for (c = 0; c < 10; c++) {
callback(100); callback(100);
sum += _source->read(); sum += _source->read();
} }
_airspeed_raw = sum/c; _airspeed_raw = sum/c;
_offset.set_and_save(_airspeed_raw); _offset.set_and_save(_airspeed_raw);
_airspeed = 0; _airspeed = 0;
} }
// read the airspeed sensor // read the airspeed sensor
void AP_Airspeed::read(void) void AP_Airspeed::read(void)
{ {
float airspeed_pressure; float airspeed_pressure;
if (!_enable) { if (!_enable) {
return; return;
} }
_airspeed_raw = _source->read(); _airspeed_raw = _source->read();
airspeed_pressure = max((_airspeed_raw - _offset), 0); airspeed_pressure = max((_airspeed_raw - _offset), 0);
_airspeed = sqrt(airspeed_pressure * _ratio); _airspeed = sqrt(airspeed_pressure * _ratio);
} }