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

fxos8701cq: add a 'stop' command

Browse Source
This commit is contained in:
Beat Küng
2018-03-12 11:56:59 +01:00
parent 06df2fcb65
commit dde922a971
1 changed files with 21 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/imu/fxos8701cq/fxos8701cq.cpp
+21 -2
View File
@@ -1698,6 +1698,7 @@ void start(bool external_bus, enum Rotation rotation, unsigned range);
void test(); void test();
void reset(); void reset();
void info(); void info();
void stop();
void regdump(); void regdump();
void usage(); void usage();
void test_error(); void test_error();
@@ -1941,6 +1942,20 @@ info()
exit(0); 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 * dump registers from device
*/ */
@@ -1977,7 +1992,7 @@ test_error()
void void
usage() 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("options:");
PX4_INFO(" -X (external bus)"); PX4_INFO(" -X (external bus)");
PX4_INFO(" -R rotation"); PX4_INFO(" -R rotation");
@@ -2034,6 +2049,10 @@ fxos8701cq_main(int argc, char *argv[])
fxos8701cq::test(); fxos8701cq::test();
} }
if (!strcmp(verb, "stop")) {
fxos8701cq::stop();
}
/* /*
* Reset the driver. * Reset the driver.
*/ */
@@ -2062,5 +2081,5 @@ fxos8701cq_main(int argc, char *argv[])
fxos8701cq::test_error(); 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'");
} }