dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

mavlink: COMMAND_LONG stream: listen to vehicle_command uorb topic and send mavlink_msg_command_long

This commit is contained in:
Thomas Gubler 2014-04-08 17:08:35 +02:00 committed by Julian Oes
parent 03a3b1d671
commit b2bc8c1f08
1 changed files with 46 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
src/modules/mavlink/mavlink_messages.cpp
View File

@ -1273,6 +1273,51 @@ protected:
}
};
class MavlinkStreamCommandLong : public MavlinkStream
{
public:
const char *get_name()
{
return "COMMAND_LONG";
}
MavlinkStream *new_instance()
{
return new MavlinkStreamCommandLong();
}
private:
MavlinkOrbSubscription *vehicle_command_sub;
struct vehicle_command_s *vehicle_command;
protected:
void subscribe(Mavlink *mavlink)
{
vehicle_command_sub = mavlink->add_orb_subscription(ORB_ID(vehicle_command));
vehicle_command = (struct vehicle_command_s *)vehicle_command_sub->get_data();
}
void send(const hrt_abstime t)
{
if (vehicle_command_sub->update(t)) {
if (!((vehicle_command->target_system == mavlink_system.sysid) && (vehicle_command->target_component == mavlink_system.compid))) {
mavlink_msg_command_long_send(_channel,
vehicle_command->target_system,
vehicle_command->target_component,
vehicle_command->command,
vehicle_command->confirmation,
vehicle_command->param1,
vehicle_command->param2,
vehicle_command->param3,
vehicle_command->param4,
vehicle_command->param5,
vehicle_command->param6,
vehicle_command->param7);
}
}
}
};
MavlinkStream *streams_list[] = {
new MavlinkStreamHeartbeat(),
new MavlinkStreamSysStatus(),
@ -1299,5 +1344,6 @@ MavlinkStream *streams_list[] = {
new MavlinkStreamAttitudeControls(),
new MavlinkStreamNamedValueFloat(),
new MavlinkStreamCameraCapture(),
new MavlinkStreamCommandLong(),
nullptr
};