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

uncomment FMU servo readback test

Browse Source
This commit is contained in:
Mark Whitehorn 2017-02-20 07:42:46 -07:00 committed by Lorenz Meier
parent 9e3488af46
commit b5169b0c7b
1 changed files with 12 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
src/drivers/px4fmu/fmu.cpp
View File

@ -3147,18 +3147,18 @@ test(void)
}
}
// /* readback servo values */
// for (unsigned i = 0; i < servo_count; i++) {
// servo_position_t value;
//
// if (ioctl(fd, PWM_SERVO_GET(i), (unsigned long)&value)) {
// err(1, "error reading PWM servo %d", i);
// }
//
// if (value != servos[i]) {
// errx(1, "servo %d readback error, got %u expected %u", i, value, servos[i]);
// }
// }
/* readback servo values */
for (unsigned i = 0; i < servo_count; i++) {
servo_position_t value;
if (ioctl(fd, PWM_SERVO_GET(i), (unsigned long)&value)) {
err(1, "error reading PWM servo %d", i);
}
if (value != servos[i]) {
errx(1, "servo %d readback error, got %u expected %u", i, value, servos[i]);
}
}
if (capture_count != 0 && (++rate_limit % 500 == 0)) {
for (unsigned i = 0; i < capture_count; i++) {