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

fxos8701cq: add a 'stop' command

Browse Source
This commit is contained in:
Beat Küng 2017-12-20 10:56:18 +01:00
parent 06df2fcb65
commit dde922a971
1 changed files with 21 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
src/drivers/imu/fxos8701cq/fxos8701cq.cpp
View File

@ -1698,6 +1698,7 @@ void start(bool external_bus, enum Rotation rotation, unsigned range);
void test();
void reset();
void info();
void stop();
void regdump();
void usage();
void test_error();
@ -1941,6 +1942,20 @@ info()
exit(0);
}
void
stop()
{
if (g_dev == nullptr) {
PX4_ERR("driver not running\n");
exit(1);
}
delete g_dev;
g_dev = nullptr;
exit(0);
}
/**
* dump registers from device
*/
@ -1977,7 +1992,7 @@ test_error()
void
usage()
{
PX4_INFO("missing command: try 'start', 'info', 'test', 'reset', 'testerror' or 'regdump'");
PX4_INFO("missing command: try 'start', 'info', 'stop', 'test', 'reset', 'testerror' or 'regdump'");
PX4_INFO("options:");
PX4_INFO(" -X (external bus)");
PX4_INFO(" -R rotation");
@ -2034,6 +2049,10 @@ fxos8701cq_main(int argc, char *argv[])
fxos8701cq::test();
}
if (!strcmp(verb, "stop")) {
fxos8701cq::stop();
}
/*
* Reset the driver.
*/
@ -2062,5 +2081,5 @@ fxos8701cq_main(int argc, char *argv[])
fxos8701cq::test_error();
}
errx(1, "unrecognized command, try 'start', 'test', 'reset', 'info', 'testerror' or 'regdump'");
errx(1, "unrecognized command, try 'start', 'stop', 'test', 'reset', 'info', 'testerror' or 'regdump'");
}