Browse Source

sf1xx: add argc check

sbg
Beat Küng 7 years ago committed by Lorenz Meier
parent
commit
490ccc0076
  1. 11
      src/drivers/distance_sensor/sf1xx/sf1xx.cpp

11
src/drivers/distance_sensor/sf1xx/sf1xx.cpp

@ -816,23 +816,25 @@ info()
int int
sf1xx_main(int argc, char *argv[]) sf1xx_main(int argc, char *argv[])
{ {
// check for optional arguments
int ch; int ch;
int myoptind = 1; int myoptind = 1;
const char *myoptarg = nullptr; const char *myoptarg = nullptr;
uint8_t rotation = distance_sensor_s::ROTATION_DOWNWARD_FACING; uint8_t rotation = distance_sensor_s::ROTATION_DOWNWARD_FACING;
while ((ch = px4_getopt(argc, argv, "R:", &myoptind, &myoptarg)) != EOF) { while ((ch = px4_getopt(argc, argv, "R:", &myoptind, &myoptarg)) != EOF) {
switch (ch) { switch (ch) {
case 'R': case 'R':
rotation = (uint8_t)atoi(myoptarg); rotation = (uint8_t)atoi(myoptarg);
PX4_INFO("Setting distance sensor orientation to %d", (int)rotation);
break; break;
default: default:
PX4_WARN("Unknown option!"); PX4_WARN("Unknown option!");
return -1;
}
} }
if (myoptind >= argc) {
goto out_error;
} }
/* /*
@ -870,6 +872,7 @@ sf1xx_main(int argc, char *argv[])
sf1xx::info(); sf1xx::info();
} }
out_error:
PX4_ERR("unrecognized command, try 'start', 'test', 'reset' or 'info'"); PX4_ERR("unrecognized command, try 'start', 'test', 'reset' or 'info'");
return PX4_ERROR; return -1;
} }

Loading…
Cancel
Save