update Diagnostics

This commit is contained in:
2026-07-07 08:59:36 +07:00
parent 397b9ab3c5
commit 1c347a4918
8 changed files with 446 additions and 2 deletions

View File

@@ -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",