diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2015-02-08 12:30:39 +0100 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2015-02-08 12:30:39 +0100 |
commit | 0fd11b78ebf027a7bf13c65c8e3ff9bd71754cc6 (patch) | |
tree | 9dabc3e4ba3c5bc91e32a45671fce39e80e3269f /src/drivers/px4io/px4io.cpp | |
parent | 769df2ff47ce05f8de95b4d355f53f2f4cc550d3 (diff) | |
download | px4-firmware-0fd11b78ebf027a7bf13c65c8e3ff9bd71754cc6.tar.gz px4-firmware-0fd11b78ebf027a7bf13c65c8e3ff9bd71754cc6.tar.bz2 px4-firmware-0fd11b78ebf027a7bf13c65c8e3ff9bd71754cc6.zip |
Fix PX4IO startup
Diffstat (limited to 'src/drivers/px4io/px4io.cpp')
-rw-r--r-- | src/drivers/px4io/px4io.cpp | 9 |
1 files changed, 8 insertions, 1 deletions
diff --git a/src/drivers/px4io/px4io.cpp b/src/drivers/px4io/px4io.cpp index cf1b89c4c..7845f8bf8 100644 --- a/src/drivers/px4io/px4io.cpp +++ b/src/drivers/px4io/px4io.cpp @@ -622,8 +622,15 @@ PX4IO::init() return ret; /* get some parameters */ - unsigned protocol = io_reg_get(PX4IO_PAGE_CONFIG, PX4IO_P_CONFIG_PROTOCOL_VERSION); + unsigned protocol; + hrt_abstime start_try_time = hrt_absolute_time(); + do { + usleep(2000); + protocol = io_reg_get(PX4IO_PAGE_CONFIG, PX4IO_P_CONFIG_PROTOCOL_VERSION); + } while (protocol == _io_reg_get_error && (hrt_elapsed_time(&start_try_time) < 700U * 1000U)); + + /* if the error still persists after timing out, we give up */ if (protocol == _io_reg_get_error) { mavlink_and_console_log_emergency(_mavlink_fd, "Failed to communicate with IO, abort."); return -1; |