|
|
|
@ -52,6 +52,7 @@ int UavcanRangefinderBridge::init()
@@ -52,6 +52,7 @@ int UavcanRangefinderBridge::init()
|
|
|
|
|
// Initialize min/max range from params
|
|
|
|
|
param_get(param_find("UAVCAN_RNG_MIN"), &_range_min_m); |
|
|
|
|
param_get(param_find("UAVCAN_RNG_MAX"), &_range_max_m); |
|
|
|
|
param_get(param_find("UAVCAN_RNG_ROT"), &_range_rot); |
|
|
|
|
|
|
|
|
|
int res = _sub_range_data.start(RangeCbBinder(this, &UavcanRangefinderBridge::range_sub_cb)); |
|
|
|
|
|
|
|
|
@ -104,6 +105,7 @@ void UavcanRangefinderBridge::range_sub_cb(const
@@ -104,6 +105,7 @@ void UavcanRangefinderBridge::range_sub_cb(const
|
|
|
|
|
rangefinder->set_fov(msg.field_of_view); |
|
|
|
|
rangefinder->set_min_distance(_range_min_m); |
|
|
|
|
rangefinder->set_max_distance(_range_max_m); |
|
|
|
|
rangefinder->set_orientation((uint8_t)_range_rot); |
|
|
|
|
|
|
|
|
|
_inited = true; |
|
|
|
|
} |
|
|
|
|