diff --git a/src/drivers/barometer/lps22hb/LPS22HB.hpp b/src/drivers/barometer/lps22hb/LPS22HB.hpp index 9d66e35490..798cf90bb8 100644 --- a/src/drivers/barometer/lps22hb/LPS22HB.hpp +++ b/src/drivers/barometer/lps22hb/LPS22HB.hpp @@ -48,7 +48,6 @@ #include #include -#include static constexpr uint8_t WHO_AM_I = 0x0F; static constexpr uint8_t LPS22HB_ID_WHO_AM_I = 0xB1; diff --git a/src/drivers/barometer/lps22hb/lps22hb_main.cpp b/src/drivers/barometer/lps22hb/lps22hb_main.cpp index 1e62596076..f503da5d48 100644 --- a/src/drivers/barometer/lps22hb/lps22hb_main.cpp +++ b/src/drivers/barometer/lps22hb/lps22hb_main.cpp @@ -33,6 +33,8 @@ #include "LPS22HB.hpp" +#include + #include extern "C" __EXPORT int lps22hb_main(int argc, char *argv[]); @@ -234,10 +236,13 @@ usage() int lps22hb_main(int argc, char *argv[]) { - enum LPS22HB_BUS busid = LPS22HB_BUS_ALL; + int myoptind = 1; int ch; + const char *myoptarg = nullptr; + + enum LPS22HB_BUS busid = LPS22HB_BUS_ALL; - while ((ch = getopt(argc, argv, "XIS:")) != EOF) { + while ((ch = px4_getopt(argc, argv, "XIS:", &myoptind, &myoptarg)) != EOF) { switch (ch) { #if (PX4_I2C_BUS_ONBOARD || PX4_SPIDEV_HMC) @@ -256,11 +261,16 @@ lps22hb_main(int argc, char *argv[]) default: lps22hb::usage(); - exit(0); + return 0; } } - const char *verb = argv[optind]; + if (myoptind >= argc) { + lps22hb::usage(); + return -1; + } + + const char *verb = argv[myoptind]; /* * Start/load the driver.