fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-29 20:14:07 +08:00
Code Issues Packages Projects Releases Wiki Activity

tap_esc: add MC_AIRMODE support

Browse Source
This commit is contained in:
Beat Küng 2018-03-27 16:17:08 +02:00 committed by Daniel Agar
parent 37d9d0c2cd
commit aa110f2075
1 changed files with 27 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

29
src/drivers/tap_esc/tap_esc.cpp
View File

@ -43,6 +43,7 @@
#include <lib/mathlib/mathlib.h>
#include <systemlib/px4_macros.h>
#include <drivers/device/device.h>
#include <px4_module_params.h>
#include <uORB/uORB.h>
#include <uORB/topics/actuator_controls.h>
#include <uORB/topics/actuator_outputs.h>
@ -51,11 +52,11 @@
#include <uORB/topics/input_rc.h>
#include <uORB/topics/esc_status.h>
#include <uORB/topics/multirotor_motor_limits.h>
#include <uORB/topics/parameter_update.h>
#include <drivers/drv_hrt.h>
#include <drivers/drv_mixer.h>
#include <lib/mixer/mixer.h>
#include <systemlib/param/param.h>
#include <systemlib/pwm_limit/pwm_limit.h>
#include "tap_esc_common.h"
@ -79,7 +80,7 @@
*/
static int _uart_fd = -1; //todo:refactor in to class
class TAP_ESC : public device::CDev
class TAP_ESC : public device::CDev, public ModuleParams
{
public:
enum Mode {
@ -113,6 +114,7 @@ private:
// subscriptions
int _armed_sub;
int _test_motor_sub;
int _params_sub;
orb_advert_t _outputs_pub;
actuator_outputs_s _outputs;
actuator_armed_s _armed;
@ -140,6 +142,12 @@ private:
unsigned _current_update_rate;
ESC_UART_BUF uartbuf;
EscPacket _packet;
DEFINE_PARAMETERS(
(ParamBool<px4::params::MC_AIRMODE>) _airmode ///< multicopter air-mode
)
void subscribe();
void work_start();
@ -167,11 +175,13 @@ TAP_ESC *tap_esc = nullptr;
TAP_ESC::TAP_ESC(int channels_count):
CDev("tap_esc", TAP_ESC_DEVICE_PATH),
ModuleParams(nullptr),
_is_armed(false),
_poll_fds_num(0),
_mode(MODE_4PWM), //FIXME: what is this mode used for???
_armed_sub(-1),
_test_motor_sub(-1),
_params_sub(-1),
_outputs_pub(nullptr),
_armed{},
_esc_feedback_pub(nullptr),
@ -574,6 +584,7 @@ TAP_ESC::cycle()
_to_mixer_status = orb_advertise(ORB_ID(multirotor_motor_limits), &multirotor_motor_limits);
_armed_sub = orb_subscribe(ORB_ID(actuator_armed));
_test_motor_sub = orb_subscribe(ORB_ID(test_motor));
_params_sub = orb_subscribe(ORB_ID(parameter_update));
_initialized = true;
}
@ -611,6 +622,9 @@ TAP_ESC::cycle()
_current_update_rate = max_rate;
}
if (_mixers) {
_mixers->set_airmode(_airmode.get());
}
/* check if anything updated */
@ -785,6 +799,16 @@ TAP_ESC::cycle()
}
/* check for parameter updates */
bool param_updated = false;
orb_check(_params_sub, &param_updated);
if (param_updated) {
struct parameter_update_s update;
orb_copy(ORB_ID(parameter_update), _params_sub, &update);
updateParams();
}
}
@ -801,6 +825,7 @@ void TAP_ESC::work_stop()
_armed_sub = -1;
orb_unsubscribe(_test_motor_sub);
_test_motor_sub = -1;
orb_unsubscribe(_params_sub);
DEVICE_LOG("stopping");
_initialized = false;