diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-29 22:33:06 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-29 22:33:06 +0200 |
commit | 676daf7c46a2458cb68aacf7b15eca3d5932c635 (patch) | |
tree | 72cae10ff62d3cdc2b9e229669037d3aac44409e /apps/ardrone_interface | |
parent | 7cd89520cc8846e5ca00f251311e6c4a50b1f7e5 (diff) | |
download | px4-firmware-676daf7c46a2458cb68aacf7b15eca3d5932c635.tar.gz px4-firmware-676daf7c46a2458cb68aacf7b15eca3d5932c635.tar.bz2 px4-firmware-676daf7c46a2458cb68aacf7b15eca3d5932c635.zip |
minor changes for default options, closing properly all subscriptions in multirotor att control now on exit
Diffstat (limited to 'apps/ardrone_interface')
-rw-r--r-- | apps/ardrone_interface/ardrone_motor_control.c | 14 |
1 files changed, 6 insertions, 8 deletions
diff --git a/apps/ardrone_interface/ardrone_motor_control.c b/apps/ardrone_interface/ardrone_motor_control.c index 81ea809f9..e96d343fc 100644 --- a/apps/ardrone_interface/ardrone_motor_control.c +++ b/apps/ardrone_interface/ardrone_motor_control.c @@ -43,6 +43,7 @@ #include <unistd.h> #include <drivers/drv_gpio.h> #include <arch/board/up_hrt.h> +#include <systemlib/err.h> #include "ardrone_motor_control.h" @@ -106,22 +107,19 @@ int ar_multiplexing_init() fd = open(GPIO_DEVICE_PATH, 0); if (fd < 0) { - printf("GPIO: open fail\n"); + warn("GPIO: open fail"); return fd; } /* deactivate all outputs */ - int ret = 0; - ret += ioctl(fd, GPIO_SET, motor_gpios); - - if (ioctl(fd, GPIO_SET_OUTPUT, motor_gpios) != 0) { - printf("GPIO: output set fail\n"); + if (ioctl(fd, GPIO_SET, motor_gpios)) { + warn("GPIO: clearing pins fail"); close(fd); return -1; } - if (ret < 0) { - printf("GPIO: clearing pins fail\n"); + if (ioctl(fd, GPIO_SET_OUTPUT, motor_gpios) != 0) { + warn("GPIO: output set fail"); close(fd); return -1; } |