Browse Source

Prevent uavcannode from republishing RTCM data received over uavcan

master
alexklimaj 3 years ago committed by Daniel Agar
parent
commit
2571860ff8
  1. 6
      src/drivers/uavcannode/Publishers/MovingBaselineData.hpp

6
src/drivers/uavcannode/Publishers/MovingBaselineData.hpp

@ -37,6 +37,7 @@ @@ -37,6 +37,7 @@
#include <ardupilot/gnss/MovingBaselineData.hpp>
#include <lib/drivers/device/Device.hpp>
#include <uORB/SubscriptionCallback.hpp>
#include <uORB/topics/gps_inject_data.h>
@ -76,7 +77,10 @@ public: @@ -76,7 +77,10 @@ public:
if (uORB::SubscriptionCallbackWorkItem::update(&inject_data)) {
// Prevent republishing rtcm data we received from uavcan
if (inject_data.device_id > uavcan::NodeID::Max) {
union device::Device::DeviceId device_id;
device_id.devid = inject_data.device_id;
if (device_id.devid_s.bus_type != device::Device::DeviceBusType::DeviceBusType_UAVCAN) {
ardupilot::gnss::MovingBaselineData movingbaselinedata{};
const size_t capacity = movingbaselinedata.data.capacity();

Loading…
Cancel
Save