diff --git a/src/drivers/uavcan/sensors/baro.cpp b/src/drivers/uavcan/sensors/baro.cpp index 22236e9e1f..7e6f6b0a90 100644 --- a/src/drivers/uavcan/sensors/baro.cpp +++ b/src/drivers/uavcan/sensors/baro.cpp @@ -85,6 +85,9 @@ UavcanBarometerBridge::air_pressure_sub_cb(const { sensor_baro_s report{}; + // Set the devid address to the UAVCAN node ID (so we get a unique address) + _device_id.devid_s.address = (uint8_t)(msg.getSrcNodeID().get() & 0xFF); + /* * FIXME HACK * This code used to rely on msg.getMonotonicTimestamp().toUSec() instead of HRT. @@ -97,8 +100,7 @@ UavcanBarometerBridge::air_pressure_sub_cb(const report.pressure = msg.static_pressure / 100.0F; // Convert to millibar report.error_count = 0; - /* TODO get device ID for sensor */ - report.device_id = 0; + report.device_id = _device_id.devid; publish(msg.getSrcNodeID().get(), &report); } diff --git a/src/drivers/uavcan/sensors/flow.cpp b/src/drivers/uavcan/sensors/flow.cpp index 33b32ab4df..5ec09f779f 100644 --- a/src/drivers/uavcan/sensors/flow.cpp +++ b/src/drivers/uavcan/sensors/flow.cpp @@ -67,6 +67,9 @@ UavcanFlowBridge::flow_sub_cb(const uavcan::ReceivedDataStructure micros flow.pixel_flow_x_integral = msg.flow_integral[0];