fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-01 05:24:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

Improved hardpoint command handling

Browse Source
This commit is contained in:
Pavel Kirienko 2016-02-02 01:20:07 +03:00 committed by Lorenz Meier
parent 7b83e828b8
commit 1ac88ec034
1 changed files with 5 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/modules/uavcan/uavcan_main.cpp
View File

@ -1385,19 +1385,16 @@ int uavcan_main(int argc, char *argv[])
const int command = atoi(argv[4]);
// Sanity check - weed out negative values, check against maximums
if (hardpoint_id >= 0 &&
hardpoint_id < 256 &&
command >= 0 &&
command < 65536) {
if (hardpoint_id >= 0 && hardpoint_id < 256 &&
command >= 0 && command < 65536) {
inst->hardpoint_controller_set((uint8_t) hardpoint_id, (uint16_t) command);
} else {
errx(1, "Are you nuts?");
errx(1, "Invalid argument");
}
} else {
errx(1, "Are you nuts?");
errx(1, "Invalid hardpoint command");
}
::exit(0);
}
if (!std::strcmp(argv[1], "stop")) {