fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-18 06:07:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

srf02 cleanup unnecessary Device CDev usage

Browse Source
This commit is contained in:
Daniel Agar
2018-08-18 15:08:16 -04:00
parent ebcd3b0b2e
commit cfe34ee19c
1 changed files with 9 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/distance_sensor/srf02/srf02.cpp
+9 -14
View File
@@ -115,7 +115,7 @@ private:
uint8_t _rotation;
float _min_distance;
float _max_distance;
work_s _work;
work_s _work{};
ringbuffer::RingBuffer *_reports;
bool _sensor_ok;
int _measure_ticks;
@@ -210,11 +210,6 @@ SRF02::SRF02(uint8_t rotation, int bus, int address) :
_index_counter(0) /* initialising temp sonar i2c address to zero */
{
/* enable debug() calls */
_debug_enabled = false;
/* work_cancel in the dtor will explode if we don't do this... */
memset(&_work, 0, sizeof(_work));
}
SRF02::~SRF02()
@@ -265,7 +260,7 @@ SRF02::init()
&_orb_class_instance, ORB_PRIO_LOW);
if (_distance_sensor_topic == nullptr) {
DEVICE_LOG("failed to create distance_sensor object. Did you start uOrb?");
PX4_ERR("failed to create distance_sensor object");
}
// XXX we should find out why we need to wait 200 ms here
@@ -281,7 +276,7 @@ SRF02::init()
if (ret2 == 0) { /* sonar is present -> store address_index in array */
addr_ind.push_back(_index_counter);
DEVICE_DEBUG("sonar added");
PX4_DEBUG("sonar added");
_latest_sonar_measurements.push_back(200);
}
}
@@ -299,10 +294,10 @@ SRF02::init()
/* show the connected sonars in terminal */
for (unsigned i = 0; i < addr_ind.size(); i++) {
DEVICE_LOG("sonar %d with address %d added", (i + 1), addr_ind[i]);
PX4_DEBUG("sonar %d with address %d added", (i + 1), addr_ind[i]);
}
DEVICE_DEBUG("Number of sonars connected: %zu", addr_ind.size());
PX4_DEBUG("Number of sonars connected: %zu", addr_ind.size());
ret = OK;
/* sensor is ok, but we don't really know if it is within range */
@@ -519,7 +514,7 @@ SRF02::measure()
if (OK != ret) {
perf_count(_comms_errors);
DEVICE_DEBUG("i2c::transfer returned %d", ret);
PX4_DEBUG("i2c::transfer returned %d", ret);
return ret;
}
@@ -542,7 +537,7 @@ SRF02::collect()
ret = transfer(nullptr, 0, &val[0], 2);
if (ret < 0) {
DEVICE_DEBUG("error reading from sensor: %d", ret);
PX4_DEBUG("error reading from sensor: %d", ret);
perf_count(_comms_errors);
perf_end(_sample_perf);
return ret;
@@ -616,7 +611,7 @@ SRF02::cycle()
/* perform collection */
if (OK != collect()) {
DEVICE_DEBUG("collection error");
PX4_DEBUG("collection error");
/* if error restart the measurement state machine */
start();
return;
@@ -655,7 +650,7 @@ SRF02::cycle()
/* Perform measurement */
if (OK != measure()) {
DEVICE_DEBUG("measure error sonar adress %d", _index_counter);
PX4_DEBUG("measure error sonar adress %d", _index_counter);
}
/* next phase is collection */