diff options
author | px4dev <px4@purgatory.org> | 2012-08-14 08:47:04 -0700 |
---|---|---|
committer | px4dev <px4@purgatory.org> | 2012-08-14 08:47:04 -0700 |
commit | 34118c72ef88d33d0074914c9bf0cda0232e4940 (patch) | |
tree | 95a797b6d8d5e7dbb82fc2c44c095de10491a1a8 /apps/px4/fmu/fmu.cpp | |
parent | 92a1fab0fd9e95737258c30fc423e839652edb72 (diff) | |
download | px4-firmware-34118c72ef88d33d0074914c9bf0cda0232e4940.tar.gz px4-firmware-34118c72ef88d33d0074914c9bf0cda0232e4940.tar.bz2 px4-firmware-34118c72ef88d33d0074914c9bf0cda0232e4940.zip |
mechanical style fixups
Diffstat (limited to 'apps/px4/fmu/fmu.cpp')
-rw-r--r-- | apps/px4/fmu/fmu.cpp | 65 |
1 files changed, 37 insertions, 28 deletions
diff --git a/apps/px4/fmu/fmu.cpp b/apps/px4/fmu/fmu.cpp index bac9431eb..9d8847246 100644 --- a/apps/px4/fmu/fmu.cpp +++ b/apps/px4/fmu/fmu.cpp @@ -100,10 +100,10 @@ private: static void task_main_trampoline(int argc, char *argv[]); void task_main(); - static int control_callback_trampoline(uintptr_t handle, - uint8_t control_group, - uint8_t control_index, - float &input); + static int control_callback_trampoline(uintptr_t handle, + uint8_t control_group, + uint8_t control_index, + float &input); int control_callback(uint8_t control_group, uint8_t control_index, float &input); @@ -285,7 +285,7 @@ FMUServo::task_main() } int -FMUServo::control_callback_trampoline(uintptr_t handle, +FMUServo::control_callback_trampoline(uintptr_t handle, uint8_t control_group, uint8_t control_index, float &input) @@ -363,6 +363,7 @@ FMUServo::ioctl(struct file *filp, int cmd, unsigned long arg) } else { *(unsigned *)arg = 2; } + break; case MIXERIOCRESET: @@ -370,22 +371,27 @@ FMUServo::ioctl(struct file *filp, int cmd, unsigned long arg) delete _mixers; _mixers = nullptr; } + break; case MIXERIOCADDSIMPLE: { - mixer_simple_s *mixinfo = (mixer_simple_s *)arg; + mixer_simple_s *mixinfo = (mixer_simple_s *)arg; - SimpleMixer *mixer = new SimpleMixer(control_callback_trampoline, (uintptr_t)this, mixinfo); - if (mixer->check()) { - delete mixer; - ret = -EINVAL; - } else { - if (_mixers == nullptr) - _mixers = new MixerGroup(control_callback_trampoline, (uintptr_t)this); - _mixers->add_mixer(mixer); + SimpleMixer *mixer = new SimpleMixer(control_callback_trampoline, (uintptr_t)this, mixinfo); + + if (mixer->check()) { + delete mixer; + ret = -EINVAL; + + } else { + if (_mixers == nullptr) + _mixers = new MixerGroup(control_callback_trampoline, (uintptr_t)this); + + _mixers->add_mixer(mixer); + } + + break; } - break; - } case MIXERIOCADDMULTIROTOR: /* XXX not yet supported */ @@ -393,20 +399,23 @@ FMUServo::ioctl(struct file *filp, int cmd, unsigned long arg) break; case MIXERIOCLOADFILE: { - const char *path = (const char *)arg; + const char *path = (const char *)arg; - if (_mixers != nullptr) { - delete _mixers; - _mixers = nullptr; - } - _mixers = new MixerGroup(control_callback_trampoline, (uintptr_t)this); - if (_mixers->load_from_file(path) != 0) { - delete _mixers; - _mixers = nullptr; - ret = -EINVAL; + if (_mixers != nullptr) { + delete _mixers; + _mixers = nullptr; + } + + _mixers = new MixerGroup(control_callback_trampoline, (uintptr_t)this); + + if (_mixers->load_from_file(path) != 0) { + delete _mixers; + _mixers = nullptr; + ret = -EINVAL; + } + + break; } - break; - } default: ret = -ENOTTY; |