Browse Source

mb12xx: add argc check and fix argv index

sbg
Beat Küng 7 years ago committed by Lorenz Meier
parent
commit
85c676316c
  1. 11
      src/drivers/distance_sensor/mb12xx/mb12xx.cpp

11
src/drivers/distance_sensor/mb12xx/mb12xx.cpp

@ -879,25 +879,27 @@ info() @@ -879,25 +879,27 @@ info()
int
mb12xx_main(int argc, char *argv[])
{
// check for optional arguments
int ch;
int myoptind = 1;
const char *myoptarg = nullptr;
uint8_t rotation = distance_sensor_s::ROTATION_DOWNWARD_FACING;
while ((ch = px4_getopt(argc, argv, "R:", &myoptind, &myoptarg)) != EOF) {
switch (ch) {
case 'R':
rotation = (uint8_t)atoi(myoptarg);
PX4_INFO("Setting distance sensor orientation to %d", (int)rotation);
break;
default:
PX4_WARN("Unknown option!");
return -1;
}
}
if (myoptind >= argc) {
goto out_error;
}
/*
* Start/load the driver.
*/
@ -929,10 +931,11 @@ mb12xx_main(int argc, char *argv[]) @@ -929,10 +931,11 @@ mb12xx_main(int argc, char *argv[])
/*
* Print driver information.
*/
if (!strcmp(argv[myoptind], "info") || !strcmp(argv[1], "status")) {
if (!strcmp(argv[myoptind], "info") || !strcmp(argv[myoptind], "status")) {
mb12xx::info();
}
out_error:
PX4_ERR("unrecognized command, try 'start', 'test', 'reset' or 'info'");
return PX4_ERROR;
}

Loading…
Cancel
Save