|
|
|
@ -816,25 +816,27 @@ info()
@@ -816,25 +816,27 @@ info()
|
|
|
|
|
int |
|
|
|
|
sf1xx_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. |
|
|
|
|
*/ |
|
|
|
@ -870,6 +872,7 @@ sf1xx_main(int argc, char *argv[])
@@ -870,6 +872,7 @@ sf1xx_main(int argc, char *argv[])
|
|
|
|
|
sf1xx::info(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
out_error: |
|
|
|
|
PX4_ERR("unrecognized command, try 'start', 'test', 'reset' or 'info'"); |
|
|
|
|
return PX4_ERROR; |
|
|
|
|
return -1; |
|
|
|
|
} |
|
|
|
|