aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorAndrew Tridgell <andrew@tridgell.net>2015-01-01 08:42:45 +1100
committerAndrew Tridgell <andrew@tridgell.net>2015-01-01 08:51:34 +1100
commit353ea9beacc5f670bb82a6dc234fcaf7c4c0f183 (patch)
tree0315b5c6be296ceaa5cd6acf118102c7e8f68a7a
parent72eafad5104ca0919f822fe44391c69f1ca80e8c (diff)
downloadpx4-firmware-353ea9beacc5f670bb82a6dc234fcaf7c4c0f183.tar.gz
px4-firmware-353ea9beacc5f670bb82a6dc234fcaf7c4c0f183.tar.bz2
px4-firmware-353ea9beacc5f670bb82a6dc234fcaf7c4c0f183.zip
l3gd20: added testerror command
useful for testing error handling
-rw-r--r--src/drivers/l3gd20/l3gd20.cpp35
1 files changed, 33 insertions, 2 deletions
diff --git a/src/drivers/l3gd20/l3gd20.cpp b/src/drivers/l3gd20/l3gd20.cpp
index 3a0c05c9e..e5ace48c9 100644
--- a/src/drivers/l3gd20/l3gd20.cpp
+++ b/src/drivers/l3gd20/l3gd20.cpp
@@ -204,6 +204,9 @@ public:
// print register dump
void print_registers();
+ // trigger an error
+ void test_error();
+
protected:
virtual int probe();
@@ -1098,6 +1101,13 @@ L3GD20::print_registers()
printf("\n");
}
+void
+L3GD20::test_error()
+{
+ // trigger a deliberate error
+ write_reg(ADDR_CTRL_REG3, 0);
+}
+
int
L3GD20::self_test()
{
@@ -1287,10 +1297,25 @@ regdump(void)
exit(0);
}
+/**
+ * trigger an error
+ */
+void
+test_error(void)
+{
+ if (g_dev == nullptr)
+ errx(1, "driver not running");
+
+ printf("regdump @ %p\n", g_dev);
+ g_dev->test_error();
+
+ exit(0);
+}
+
void
usage()
{
- warnx("missing command: try 'start', 'info', 'test', 'reset' or 'regdump'");
+ warnx("missing command: try 'start', 'info', 'test', 'reset', 'testerror' or 'regdump'");
warnx("options:");
warnx(" -X (external bus)");
warnx(" -R rotation");
@@ -1353,5 +1378,11 @@ l3gd20_main(int argc, char *argv[])
if (!strcmp(verb, "regdump"))
l3gd20::regdump();
- errx(1, "unrecognized command, try 'start', 'test', 'reset', 'info' or 'regdump'");
+ /*
+ * trigger an error
+ */
+ if (!strcmp(verb, "testerror"))
+ l3gd20::test_error();
+
+ errx(1, "unrecognized command, try 'start', 'test', 'reset', 'info', 'testerror' or 'regdump'");
}