From f6c0d2310d538e44c3764f3a13d80789ca34170e Mon Sep 17 00:00:00 2001 From: Thomas Gubler Date: Wed, 14 Jan 2015 07:41:14 +0100 Subject: ros mixer node: add w mixer --- src/platforms/ros/nodes/mc_mixer/mc_mixer.cpp | 13 ++++++++++--- 1 file changed, 10 insertions(+), 3 deletions(-) (limited to 'src/platforms/ros/nodes') diff --git a/src/platforms/ros/nodes/mc_mixer/mc_mixer.cpp b/src/platforms/ros/nodes/mc_mixer/mc_mixer.cpp index 1073833c0..e66558fe2 100644 --- a/src/platforms/ros/nodes/mc_mixer/mc_mixer.cpp +++ b/src/platforms/ros/nodes/mc_mixer/mc_mixer.cpp @@ -101,17 +101,24 @@ const MultirotorMixer::Rotor _config_quad_plus_euroc[] = { { 1.000000, 0.000000, -1.00 }, { -1.000000, 0.000000, -1.00 }, }; +const MultirotorMixer::Rotor _config_quad_wide[] = { + { -0.927184, 0.374607, 1.000000 }, + { 0.777146, -0.629320, 1.000000 }, + { 0.927184, 0.374607, -1.000000 }, + { -0.777146, -0.629320, -1.000000 }, +}; -const MultirotorMixer::Rotor *_config_index[3] = { +const MultirotorMixer::Rotor *_config_index[4] = { &_config_x[0], &_config_quad_plus[0], - &_config_quad_plus_euroc[0] + &_config_quad_plus_euroc[0], + &_config_quad_wide[0] }; MultirotorMixer::MultirotorMixer(): _n(), _rotor_count(4), - _rotors(_config_index[0]) //XXX hardcoded + _rotors(_config_index[3]) //XXX hardcoded { _sub = _n.subscribe("actuator_controls_0", 1, &MultirotorMixer::actuatorControlsCallback, this); _pub = _n.advertise("/mixed_motor_commands", 10); -- cgit v1.2.3