mavlink: fix transmitting vehicle commands

This commit is contained in:
Oleg Kalachev
2018-05-06 15:43:33 +03:00
committed by Lorenz Meier
parent 9fa882119d
commit 532a970410
+2
View File
@@ -1337,6 +1337,7 @@ void Mavlink::send_protocol_version()
MavlinkOrbSubscription *Mavlink::add_orb_subscription(const orb_id_t topic, int instance) MavlinkOrbSubscription *Mavlink::add_orb_subscription(const orb_id_t topic, int instance)
{ {
if (topic != ORB_ID(vehicle_command)) {
/* check if already subscribed to this topic */ /* check if already subscribed to this topic */
MavlinkOrbSubscription *sub; MavlinkOrbSubscription *sub;
@@ -1346,6 +1347,7 @@ MavlinkOrbSubscription *Mavlink::add_orb_subscription(const orb_id_t topic, int
return sub; return sub;
} }
} }
}
/* add new subscription */ /* add new subscription */
MavlinkOrbSubscription *sub_new = new MavlinkOrbSubscription(topic, instance); MavlinkOrbSubscription *sub_new = new MavlinkOrbSubscription(topic, instance);