update Diagnostics
This commit is contained in:
@@ -23,6 +23,15 @@ int main() {
|
||||
i, scan.ranges.size(), scan.timestamp_ms, info.error_status,
|
||||
info.detected_model.c_str());
|
||||
|
||||
// Chẩn đoán thiết bị từ scan mới nhất
|
||||
lidarlib::Diagnostics diag = drv.get_diagnostics();
|
||||
printf(" diag: %s\n", lidarlib::to_string(diag).c_str());
|
||||
if (diag.has_fault()) {
|
||||
if (diag.monitor_fault()) printf(" !! lỗi monitor/motor\n");
|
||||
if (diag.voltage_fault()) printf(" !! điện áp bất thường\n");
|
||||
if (diag.temperature_fault()) printf(" !! nhiệt độ bất thường\n");
|
||||
}
|
||||
|
||||
for (size_t j = 0; j < 20 && j < scan.ranges.size(); ++j) {
|
||||
float angle_deg = (scan.angle_min + j * scan.angle_increment) * 180.f / 3.14159265f;
|
||||
printf(" [%zu] angle=%.2f° dist=%.3fm intensity=%.0f\n",
|
||||
|
||||
Reference in New Issue
Block a user