Skip to content
Snippets Groups Projects
Commit b83b588f authored by DanielePettenuzzo's avatar DanielePettenuzzo Committed by Lorenz Meier
Browse files

irlock driver: fix bus selection argument (-b)

parent 988ce71e
No related branches found
No related tags found
No related merge requests found
......@@ -54,6 +54,8 @@
#include <drivers/drv_irlock.h>
#include <drivers/drv_hrt.h>
#include <px4_getopt.h>
#include <nuttx/clock.h>
#include <nuttx/wqueue.h>
#include <systemlib/err.h>
......@@ -449,17 +451,28 @@ int irlock_main(int argc, char *argv[])
{
int i2cdevice = IRLOCK_I2C_BUS;
/** jump over start/off/etc and look at options first **/
if (getopt(argc, argv, "b:") != EOF) {
i2cdevice = (int)strtol(optarg, NULL, 0);
int ch;
int myoptind = 1;
const char *myoptarg = nullptr;
while ((ch = px4_getopt(argc, argv, "b:", &myoptind, &myoptarg)) != EOF) {
switch (ch) {
case 'b':
i2cdevice = (uint8_t)atoi(myoptarg);
break;
default:
PX4_WARN("Unknown option!");
return -1;
}
}
if (optind >= argc) {
if (myoptind >= argc) {
irlock_usage();
exit(1);
}
const char *command = argv[optind];
const char *command = argv[myoptind];
/** start driver **/
if (!strcmp(command, "start")) {
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment