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

Abort the px4io worker task if subscribing to the required ORB topics fails.

Browse Source
This commit is contained in:
px4dev 2013-07-06 00:00:10 -07:00
parent a4b0e3ecbe
commit 0589346ce6
1 changed files with 9 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/drivers/px4io/px4io.cpp
View File

@ -572,6 +572,14 @@ PX4IO::task_main()
_t_param = orb_subscribe(ORB_ID(parameter_update));
orb_set_interval(_t_param, 500); /* 2Hz update rate max. */
if ((_t_actuators < 0) ||
(_t_armed < 0) ||
(_t_vstatus < 0) ||
(_t_param < 0)) {
log("subscription(s) failed");
goto out;
}
/* poll descriptor */
pollfd fds[4];
fds[0].fd = _t_actuators;
@ -668,6 +676,7 @@ PX4IO::task_main()
unlock();
out:
debug("exiting");
/* clean up the alternate device node */