diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-07-29 02:25:42 -0700 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-07-29 02:25:42 -0700 |
commit | 1ab6eb2fb87c0bff617e4abd100fc8d62817106c (patch) | |
tree | 83ec4738b45a919e8470cf025e300763adffa00e /src | |
parent | e2c96876f2df85e5d1f2b27a368a81bc7a3a24de (diff) | |
parent | 80a197f0fffb39037ce271bbc2e2107f2208eb01 (diff) | |
download | px4-firmware-1ab6eb2fb87c0bff617e4abd100fc8d62817106c.tar.gz px4-firmware-1ab6eb2fb87c0bff617e4abd100fc8d62817106c.tar.bz2 px4-firmware-1ab6eb2fb87c0bff617e4abd100fc8d62817106c.zip |
Merge pull request #1228 from PX4/mavlinkonboard
Mavlink onboard
Diffstat (limited to 'src')
-rw-r--r-- | src/modules/mavlink/mavlink_main.cpp | 7 | ||||
-rw-r--r-- | src/modules/mavlink/mavlink_receiver.cpp | 3 |
2 files changed, 8 insertions, 2 deletions
diff --git a/src/modules/mavlink/mavlink_main.cpp b/src/modules/mavlink/mavlink_main.cpp index fbe09564b..861c91d47 100644 --- a/src/modules/mavlink/mavlink_main.cpp +++ b/src/modules/mavlink/mavlink_main.cpp @@ -483,7 +483,12 @@ Mavlink::forward_message(const mavlink_message_t *msg, Mavlink *self) Mavlink *inst; LL_FOREACH(_mavlink_instances, inst) { if (inst != self) { - inst->pass_message(msg); + + /* if not in normal mode, we are an onboard link + * onboard links should only pass on messages from the same system ID */ + if(!(self->_mode != MAVLINK_MODE_NORMAL && msg->sysid != mavlink_system.sysid)) { + inst->pass_message(msg); + } } } } diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index 54c412ce7..69e3ef31d 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -241,7 +241,8 @@ MavlinkReceiver::handle_message_command_long(mavlink_message_t *msg) } else { if (msg->sysid == mavlink_system.sysid && msg->compid == mavlink_system.compid) { - warnx("ignoring CMD spoofed with same SYS/COMP ID"); + warnx("ignoring CMD spoofed with same SYS/COMP (%d/%d) ID", + mavlink_system.sysid, mavlink_system.compid); return; } |