Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-08 02:17:07 +08:00
Code Issues Actions 29 Packages Projects Releases Wiki Activity

Fix CID 12453

Browse Source
This commit is contained in:
Lorenz Meier
2015-01-20 14:21:03 +01:00
parent 603b43b6d8
commit 81082c4119
1 changed files with 11 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/px4io/px4io.cpp
+11 -3
View File
@@ -1144,11 +1144,13 @@ PX4IO::io_set_control_state(unsigned group)
break;
}
if (!changed)
if (!changed) {
return -1;
}
for (unsigned i = 0; i < _max_controls; i++)
for (unsigned i = 0; i < _max_controls; i++) {
regs[i] = FLOAT_TO_REG(controls.control[i]);
}
/* copy values to registers in IO */
return io_reg_set(PX4IO_PAGE_CONTROLS, group * PX4IO_PROTOCOL_MAX_CONTROL_COUNT, regs, _max_controls);
@@ -3240,7 +3242,13 @@ px4io_main(int argc, char *argv[])
if (!strcmp(argv[1], "limit")) {
if ((argc > 2)) {
g_dev->set_update_rate(atoi(argv[2]));
int limitrate = atoi(argv[2]);
if (limitrate > 0) {
g_dev->set_update_rate(limitrate);
} else {
errx(1, "invalid rate: %d", limitrate);
}
} else {
errx(1, "missing argument (50 - 500 Hz)");