diff options
author | orlando3d <orlando@3drobotics.com> | 2015-03-19 09:39:44 -0800 |
---|---|---|
committer | orlando3d <orlando@3drobotics.com> | 2015-03-19 09:39:44 -0800 |
commit | e6688826212aec1c33a042593206fbcea45f112d (patch) | |
tree | ae7217a2d40e3cda7900d5938fef3a3298c420e1 /src/systemcmds | |
parent | 86970eead7919193a62022e9a9f0efe05d660dc6 (diff) | |
download | px4-firmware-e6688826212aec1c33a042593206fbcea45f112d.tar.gz px4-firmware-e6688826212aec1c33a042593206fbcea45f112d.tar.bz2 px4-firmware-e6688826212aec1c33a042593206fbcea45f112d.zip |
Turn on PWM output for PPM loopback test
Diffstat (limited to 'src/systemcmds')
-rw-r--r-- | src/systemcmds/tests/test_ppm_loopback.c | 19 |
1 files changed, 9 insertions, 10 deletions
diff --git a/src/systemcmds/tests/test_ppm_loopback.c b/src/systemcmds/tests/test_ppm_loopback.c index a753f45c2..6866531d7 100644 --- a/src/systemcmds/tests/test_ppm_loopback.c +++ b/src/systemcmds/tests/test_ppm_loopback.c @@ -105,16 +105,15 @@ int test_ppm_loopback(int argc, char *argv[]) int pwm_values[] = {1200, 1300, 1900, 1700, 1500, 1250, 1800, 1400}; - // for (unsigned i = 0; (i < servo_count) && (i < sizeof(pwm_values) / sizeof(pwm_values[0])); i++) { - // result = ioctl(servo_fd, PWM_SERVO_SET(i), pwm_values[i]); - - // if (result) { - // (void)close(servo_fd); - // return ERROR; - // } else { - // warnx("channel %d set to %d", i, pwm_values[i]); - // } - // } + for (unsigned i = 0; (i < servo_count) && (i < sizeof(pwm_values) / sizeof(pwm_values[0])); i++) { + result = ioctl(servo_fd, PWM_SERVO_SET(i), pwm_values[i]); + if (result) { + (void)close(servo_fd); + return ERROR; + } else { + warnx("channel %d set to %d", i, pwm_values[i]); + } + } warnx("servo count: %d", servo_count); |