fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

bmi160: add argc check and use px4_getopt

Browse Source
This commit is contained in:
Beat Küng 2018-06-04 14:29:14 +02:00 committed by Lorenz Meier
parent 8f5fb3d0e5
commit a0d4e7aa90
1 changed files with 14 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
src/drivers/imu/bmi160/bmi160_main.cpp
View File

@ -2,6 +2,7 @@
#include "bmi160.hpp"
#include <board_config.h>
#include <px4_getopt.h>
/** driver 'main' command */
extern "C" { __EXPORT int bmi160_main(int argc, char *argv[]); }
@ -271,32 +272,37 @@ usage()
int
bmi160_main(int argc, char *argv[])
{
bool external_bus = false;
int myoptind = 1;
int ch;
const char *myoptarg = nullptr;
bool external_bus = false;
enum Rotation rotation = ROTATION_NONE;
/* jump over start/off/etc and look at options first */
while ((ch = getopt(argc, argv, "XR:")) != EOF) {
while ((ch = px4_getopt(argc, argv, "XR:", &myoptind, &myoptarg)) != EOF) {
switch (ch) {
case 'X':
external_bus = true;
break;
case 'R':
rotation = (enum Rotation)atoi(optarg);
rotation = (enum Rotation)atoi(myoptarg);
break;
default:
bmi160::usage();
exit(0);
return 0;
}
}
const char *verb = argv[optind];
if (myoptind >= argc) {
bmi160::usage();
return -1;
}
const char *verb = argv[myoptind];
/*
* Start/load the driver.
*/
if (!strcmp(verb, "start")) {
bmi160::start(external_bus, rotation);
@ -339,5 +345,5 @@ bmi160_main(int argc, char *argv[])
}
bmi160::usage();
exit(1);
return -1;
}