mirror of https://github.com/ArduPilot/ardupilot
GCS_MAVLink: add defines for serial control, deviceop and servo_relay
This commit is contained in:
parent
820d00dfcd
commit
8473f05738
|
@ -3874,12 +3874,15 @@ void GCS_MAVLINK::handle_common_message(const mavlink_message_t &msg)
|
||||||
handle_set_gps_global_origin(msg);
|
handle_set_gps_global_origin(msg);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#if AP_MAVLINK_MSG_DEVICE_OP_ENABLED
|
||||||
case MAVLINK_MSG_ID_DEVICE_OP_READ:
|
case MAVLINK_MSG_ID_DEVICE_OP_READ:
|
||||||
handle_device_op_read(msg);
|
handle_device_op_read(msg);
|
||||||
break;
|
break;
|
||||||
case MAVLINK_MSG_ID_DEVICE_OP_WRITE:
|
case MAVLINK_MSG_ID_DEVICE_OP_WRITE:
|
||||||
handle_device_op_write(msg);
|
handle_device_op_write(msg);
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case MAVLINK_MSG_ID_TIMESYNC:
|
case MAVLINK_MSG_ID_TIMESYNC:
|
||||||
handle_timesync(msg);
|
handle_timesync(msg);
|
||||||
break;
|
break;
|
||||||
|
@ -3973,9 +3976,11 @@ void GCS_MAVLINK::handle_common_message(const mavlink_message_t &msg)
|
||||||
handle_param_value(msg);
|
handle_param_value(msg);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
#if AP_MAVLINK_MSG_SERIAL_CONTROL_ENABLED
|
||||||
case MAVLINK_MSG_ID_SERIAL_CONTROL:
|
case MAVLINK_MSG_ID_SERIAL_CONTROL:
|
||||||
handle_serial_control(msg);
|
handle_serial_control(msg);
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case MAVLINK_MSG_ID_GPS_RTCM_DATA:
|
case MAVLINK_MSG_ID_GPS_RTCM_DATA:
|
||||||
case MAVLINK_MSG_ID_GPS_INPUT:
|
case MAVLINK_MSG_ID_GPS_INPUT:
|
||||||
|
@ -5139,7 +5144,7 @@ MAV_RESULT GCS_MAVLINK::handle_command_int_packet(const mavlink_command_int_t &p
|
||||||
return handle_command_mag_cal(packet);
|
return handle_command_mag_cal(packet);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if AP_SERVORELAYEVENTS_ENABLED
|
#if AP_MAVLINK_SERVO_RELAY_ENABLED
|
||||||
case MAV_CMD_DO_SET_SERVO:
|
case MAV_CMD_DO_SET_SERVO:
|
||||||
case MAV_CMD_DO_REPEAT_SERVO:
|
case MAV_CMD_DO_REPEAT_SERVO:
|
||||||
case MAV_CMD_DO_SET_RELAY:
|
case MAV_CMD_DO_SET_RELAY:
|
||||||
|
|
|
@ -15,6 +15,11 @@
|
||||||
/*
|
/*
|
||||||
handle device operations over MAVLink
|
handle device operations over MAVLink
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#include "GCS_config.h"
|
||||||
|
|
||||||
|
#if AP_MAVLINK_MSG_DEVICE_OP_ENABLED
|
||||||
|
|
||||||
#include <AP_HAL/AP_HAL.h>
|
#include <AP_HAL/AP_HAL.h>
|
||||||
#include <AP_HAL/Device.h>
|
#include <AP_HAL/Device.h>
|
||||||
#include <AP_HAL/I2CDevice.h>
|
#include <AP_HAL/I2CDevice.h>
|
||||||
|
@ -137,3 +142,5 @@ fail:
|
||||||
packet.request_id,
|
packet.request_id,
|
||||||
retcode);
|
retcode);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif // AP_MAVLINK_MSG_DEVICE_OP_ENABLED
|
||||||
|
|
|
@ -2,7 +2,7 @@
|
||||||
|
|
||||||
#include "AP_ServoRelayEvents/AP_ServoRelayEvents.h"
|
#include "AP_ServoRelayEvents/AP_ServoRelayEvents.h"
|
||||||
|
|
||||||
#if AP_SERVORELAYEVENTS_ENABLED
|
#if AP_MAVLINK_SERVO_RELAY_ENABLED
|
||||||
|
|
||||||
MAV_RESULT GCS_MAVLINK::handle_servorelay_message(const mavlink_command_int_t &packet)
|
MAV_RESULT GCS_MAVLINK::handle_servorelay_message(const mavlink_command_int_t &packet)
|
||||||
{
|
{
|
||||||
|
@ -48,4 +48,4 @@ MAV_RESULT GCS_MAVLINK::handle_servorelay_message(const mavlink_command_int_t &p
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif // AP_SERVORELAYEVENTS_ENABLED
|
#endif // AP_MAVLINK_SERVO_RELAY_ENABLED
|
||||||
|
|
|
@ -61,3 +61,16 @@
|
||||||
#ifndef AP_MAVLINK_MSG_MOUNT_CONTROL_ENABLED
|
#ifndef AP_MAVLINK_MSG_MOUNT_CONTROL_ENABLED
|
||||||
#define AP_MAVLINK_MSG_MOUNT_CONTROL_ENABLED HAL_GCS_ENABLED
|
#define AP_MAVLINK_MSG_MOUNT_CONTROL_ENABLED HAL_GCS_ENABLED
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
// this is for both read and write messages:
|
||||||
|
#ifndef AP_MAVLINK_MSG_DEVICE_OP_ENABLED
|
||||||
|
#define AP_MAVLINK_MSG_DEVICE_OP_ENABLED HAL_GCS_ENABLED
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef AP_MAVLINK_SERVO_RELAY_ENABLED
|
||||||
|
#define AP_MAVLINK_SERVO_RELAY_ENABLED HAL_GCS_ENABLED && AP_SERVORELAYEVENTS_ENABLED
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef AP_MAVLINK_MSG_SERIAL_CONTROL_ENABLED
|
||||||
|
#define AP_MAVLINK_MSG_SERIAL_CONTROL_ENABLED HAL_GCS_ENABLED
|
||||||
|
#endif
|
||||||
|
|
|
@ -17,6 +17,9 @@
|
||||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#include "GCS_config.h"
|
||||||
|
|
||||||
|
#if AP_MAVLINK_MSG_SERIAL_CONTROL_ENABLED
|
||||||
|
|
||||||
#include <AP_HAL/AP_HAL.h>
|
#include <AP_HAL/AP_HAL.h>
|
||||||
#include "GCS.h"
|
#include "GCS.h"
|
||||||
|
@ -199,3 +202,5 @@ more_data:
|
||||||
goto more_data;
|
goto more_data;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif // AP_MAVLINK_MSG_SERIAL_CONTROL_ENABLED
|
||||||
|
|
Loading…
Reference in New Issue