yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

Baro sim: Cleanup

Browse Source
This commit is contained in:
Lorenz Meier
2016-03-12 11:07:55 +01:00
parent c1321ec721
commit 32368e5eda
1 changed files with 6 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files

25
src/platforms/posix/drivers/barosim/baro.cpp
View File

@@ -111,12 +111,8 @@ protected:
bool _collect_phase;
unsigned _measure_phase;
/* intermediate temperature values per BAROSIM datasheet */
int32_t _TEMP;
int64_t _OFF;
int64_t _SENS;
float _P;
float _T;
/* last report */
struct baro_report report;
/* altitude conversion calibration */
unsigned _msl_pressure; /* in Pa */
@@ -202,11 +198,7 @@ BAROSIM::BAROSIM(const char *path) :
_reports(nullptr),
_collect_phase(false),
_measure_phase(0),
_TEMP(0),
_OFF(0),
_SENS(0),
_P(0.0),
_T(0.0),
report{},
_msl_pressure(101325),
_baro_topic(nullptr),
_orb_class_instance(-1),
@@ -391,7 +383,7 @@ BAROSIM::devRead(void *buffer, size_t buflen)
int
BAROSIM::devIOCTL(unsigned long cmd, unsigned long arg)
{
PX4_WARN("baro IOCTL %" PRIu64 , hrt_absolute_time());
//PX4_WARN("baro IOCTL %" PRIu64 , hrt_absolute_time());
switch (cmd) {
@@ -664,7 +656,6 @@ BAROSIM::collect()
perf_begin(_sample_perf);
struct baro_report report = {};
/* this should be fairly close to the end of the conversion, so the best approximation of the time */
report.timestamp = hrt_absolute_time();
report.error_count = perf_event_count(_comms_errors);
@@ -726,12 +717,8 @@ BAROSIM::print_info()
perf_print_counter(_buffer_overflows);
PX4_INFO("poll interval: %u usec", m_sample_interval_usecs);
_reports->print_info("report queue");
PX4_INFO("TEMP: %ld", (long)_TEMP);
PX4_INFO("SENS: %lld", (long long)_SENS);
PX4_INFO("OFF: %lld", (long long)_OFF);
PX4_INFO("P: %.3f", (double)_P);
PX4_INFO("T: %.3f", (double)_T);
PX4_INFO("MSL pressure: %10.4f", (double)(_msl_pressure / 100.f));
PX4_INFO("TEMP: %f", (double)report.temperature);
PX4_INFO("P: %.3f", (double)report.pressure);
}
namespace barosim