fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-06 05:01:37 +08:00
Code Issues Packages Projects Releases Wiki Activity

Extend the PCF8583 driver to support multiple instances (#19232)

Browse Source 
* Add some restart events into pcf8583 driver

Co-authored-by: Vít Hanousek <vithanousek@seznam.cz>
This commit is contained in:
Roman Dvořák
2022-02-21 16:47:16 -05:00
committed by GitHub
co-authored by Vít Hanousek
parent 3c58932aff
commit 976c994156
7 changed files with 151 additions and 49 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/streams/RAW_RPM.hpp
+13 -9
View File
@@ -49,29 +49,33 @@ public:
unsigned get_size() override
{
return _rpm_sub.advertised() ? (MAVLINK_MSG_ID_RAW_RPM_LEN + MAVLINK_NUM_NON_PAYLOAD_BYTES) : 0;
return _rpm_subs.advertised_count() * (MAVLINK_MSG_ID_RAW_RPM_LEN + MAVLINK_NUM_NON_PAYLOAD_BYTES);
}
private:
explicit MavlinkStreamRawRpm(Mavlink *mavlink) : MavlinkStream(mavlink) {}
uORB::Subscription _rpm_sub{ORB_ID(rpm)};
uORB::SubscriptionMultiArray<rpm_s> _rpm_subs{ORB_ID::rpm};
bool send() override
{
rpm_s rpm;
bool updated = false;
if (_rpm_sub.update(&rpm)) {
mavlink_raw_rpm_t msg{};
for (int i = 0; i < _rpm_subs.size(); i++) {
rpm_s rpm;
msg.frequency = rpm.indicated_frequency_rpm;
if (_rpm_subs[i].update(&rpm)) {
mavlink_raw_rpm_t msg{};
mavlink_msg_raw_rpm_send_struct(_mavlink->get_channel(), &msg);
msg.index = i;
msg.frequency = rpm.indicated_frequency_rpm;
return true;
mavlink_msg_raw_rpm_send_struct(_mavlink->get_channel(), &msg);
updated = true;
}
}
return false;
return updated;
}
};