fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-21 00:33:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

drivers start using uORB message print instead of custom

Browse Source
This commit is contained in:
Daniel Agar
2018-03-28 09:15:41 -04:00
parent 3db17a04fc
commit 5fba1f38b2
33 changed files with 79 additions and 426 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/distance_sensor/hc_sr04/hc_sr04.cpp
+2 -12
View File
@@ -801,10 +801,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f of sonar %d,id=%d", (double)report.distance_vector[report.just_updated], report.just_updated,
report.id[report.just_updated]);
warnx("time: %lld", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -831,14 +828,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
/* Print the sonar rangefinder report sonar distance vector */
for (uint8_t count = 0; count < SRF02_MAX_RANGEFINDERS; count++) {
warnx("measurement: %0.3f of sonar %u, id=%d", (double)report.distance_vector[count], count + 1, report.id[count]);
}
warnx("time: %lld", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/leddar_one/leddar_one.cpp
+1 -10
View File
@@ -231,16 +231,7 @@ int leddar_one_main(int argc, char *argv[])
return PX4_ERROR;
}
bool valid = false;
if (report.current_distance > report.min_distance
&& report.current_distance < report.max_distance) {
valid = true;
}
warnx("valid: %u\n", valid);
warnx("distance: %0.3fm\n", (double)report.current_distance);
warnx("time: %llu\n", report.timestamp);
print_message(report);
} else {
help();
src/drivers/distance_sensor/ll40ls/LidarLitePWM.cpp
+2 -1
View File
@@ -123,7 +123,8 @@ void LidarLitePWM::print_info()
perf_print_counter(_read_errors);
perf_print_counter(_sensor_zero_resets);
warnx("poll interval: %u ticks", getMeasureTicks());
warnx("distance: %.3fm", (double)_range.current_distance);
print_message(_range);
}
void LidarLitePWM::print_registers()
src/drivers/distance_sensor/ll40ls/ll40ls.cpp
+2 -8
View File
@@ -217,9 +217,7 @@ test()
return;
}
PX4_INFO("single read");
PX4_INFO("measurement: %0.2f m", (double)report.current_distance);
PX4_INFO("time: %lld", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (PX4_OK != px4_ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -249,11 +247,7 @@ test()
return;
}
PX4_INFO("periodic read %u", i);
PX4_INFO("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
PX4_INFO("measurement: %0.3f m", (double)report.current_distance);
PX4_INFO("time: %lld", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/mb12xx/mb12xx.cpp
+2 -8
View File
@@ -797,9 +797,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -826,11 +824,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/sf0x/sf0x.cpp
+2 -8
View File
@@ -863,9 +863,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2 Hz rate */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -894,11 +892,7 @@ test()
break;
}
warnx("read #%u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to the default rate */
src/drivers/distance_sensor/sf1xx/sf1xx.cpp
+2 -8
View File
@@ -732,9 +732,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -761,11 +759,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/srf02/srf02.cpp
+2 -8
View File
@@ -801,9 +801,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -830,11 +828,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/srf02_i2c/srf02_i2c.cpp
+2 -8
View File
@@ -801,9 +801,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -830,11 +828,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/teraranger/teraranger.cpp
+2 -6
View File
@@ -845,9 +845,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2Hz */
if (OK != ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -874,9 +872,7 @@ test()
err(1, "periodic read failed");
}
warnx("periodic read %u", i);
warnx("measurement: %0.3f", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to default rate */
src/drivers/distance_sensor/tfmini/tfmini.cpp
+2 -8
View File
@@ -828,9 +828,7 @@ test()
err(1, "immediate read failed");
}
warnx("single read");
warnx("measurement: %0.2f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
/* start the sensor polling at 2 Hz rate */
if (OK != px4_ioctl(fd, SENSORIOCSPOLLRATE, 2)) {
@@ -859,11 +857,7 @@ test()
break;
}
warnx("read #%u", i);
warnx("valid %u", (float)report.current_distance > report.min_distance
&& (float)report.current_distance < report.max_distance ? 1 : 0);
warnx("measurement: %0.3f m", (double)report.current_distance);
warnx("time: %llu", report.timestamp);
print_message(report);
}
/* reset the sensor polling to the default rate */