Browse Source

AP_Periph: use rangefinder get_address()

c415-sdk
Andrew Tridgell 5 years ago
parent
commit
d789c618a2
  1. 1
      Tools/AP_Periph/can.cpp

1
Tools/AP_Periph/can.cpp

@ -1595,6 +1595,7 @@ void AP_Periph_FW::can_rangefinder_update(void) @@ -1595,6 +1595,7 @@ void AP_Periph_FW::can_rangefinder_update(void)
}
uint16_t dist_cm = rangefinder.distance_cm_orient(ROTATION_NONE);
uavcan_equipment_range_sensor_Measurement pkt {};
pkt.sensor_id = rangefinder.get_address(0);
switch (status) {
case RangeFinder::Status::OutOfRangeLow:
pkt.reading_type = UAVCAN_EQUIPMENT_RANGE_SENSOR_MEASUREMENT_READING_TYPE_TOO_CLOSE;

Loading…
Cancel
Save