yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

tune_control: Add checks for the strength

Browse Source
This commit is contained in:
Simone Guscetti
2017-03-13 14:07:29 +01:00
committed by Daniel Agar
parent 591f9a8a38
commit 6e712876a4
1 changed files with 14 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
src/systemcmds/tune_control/tune_control.cpp
View File

@@ -94,7 +94,7 @@ tune_control_main(int argc, char *argv[])
int myoptind = 1;
int ch;
const char *myoptarg = NULL;
uint8_t value;
unsigned int value;
tune_control_s tune_control = {};
tune_control.tune_id = 0;
tune_control.strength = 40;
@@ -102,8 +102,10 @@ tune_control_main(int argc, char *argv[])
while ((ch = px4_getopt(argc, argv, "f:d:t:m:s:", &myoptind, &myoptarg)) != EOF) {
switch (ch) {
case 'f':
if ((uint16_t)(strtol(myoptarg, NULL, 0)) > 0 && (uint16_t)(strtol(myoptarg, NULL, 0)) < 22000) {
tune_control.frequency = (uint16_t)(strtol(myoptarg, NULL, 0));
value = (uint16_t)(strtol(myoptarg, NULL, 0));
if (value > 0 && value < 22000) {
tune_control.frequency = value;
} else {
usage();
@@ -142,7 +144,15 @@ tune_control_main(int argc, char *argv[])
break;
case 's':
tune_control.strength = (uint16_t)(strtol(myoptarg, NULL, 0));
value = (uint16_t)(strtol(myoptarg, NULL, 0));
if (value > 0 && value < 100) {
tune_control.strength = value;
} else {
tune_control.strength = 40;
}
break;
default: