|
|
|
@ -467,31 +467,33 @@ transition_result_t hil_state_transition(hil_state_t new_state, orb_advert_t sta
@@ -467,31 +467,33 @@ transition_result_t hil_state_transition(hil_state_t new_state, orb_advert_t sta
|
|
|
|
|
|
|
|
|
|
#else |
|
|
|
|
|
|
|
|
|
std::string devname; |
|
|
|
|
unsigned int index = 0; |
|
|
|
|
for(;;) { |
|
|
|
|
if (DevMgr::getNextDeviceName(index, devname) < 0) { |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
// TODO NOT IMPLEMENTED
|
|
|
|
|
|
|
|
|
|
/* skip mavlink */ |
|
|
|
|
if (!strcmp("/dev/mavlink", devname.c_str())) { |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
// std::string devname;
|
|
|
|
|
// unsigned int index = 0;
|
|
|
|
|
// for(;;) {
|
|
|
|
|
// if (DevMgr::getNextDeviceName(index, devname) < 0) {
|
|
|
|
|
// break;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
DevHandle h; |
|
|
|
|
DevMgr::getHandle(devname.c_str(), h); |
|
|
|
|
// /* skip mavlink */
|
|
|
|
|
// if (!strcmp("/dev/mavlink", devname.c_str())) {
|
|
|
|
|
// continue;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
if (!h.isValid()) { |
|
|
|
|
warn("failed opening device %s", devname.c_str()); |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
// DevHandle h;
|
|
|
|
|
// DevMgr::getHandle(devname.c_str(), h);
|
|
|
|
|
|
|
|
|
|
int block_ret = h.ioctl(DEVIOCSPUBBLOCK, (void *)1); |
|
|
|
|
DevMgr::releaseHandle(h); |
|
|
|
|
// if (!h.isValid()) {
|
|
|
|
|
// warn("failed opening device %s", devname.c_str());
|
|
|
|
|
// continue;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
printf("Disabling %s: %s\n", devname.c_str(), (block_ret == OK) ? "OK" : "ERROR"); |
|
|
|
|
} |
|
|
|
|
// int block_ret = h.ioctl(DEVIOCSPUBBLOCK, (void *)1);
|
|
|
|
|
// DevMgr::releaseHandle(h);
|
|
|
|
|
|
|
|
|
|
// printf("Disabling %s: %s\n", devname.c_str(), (block_ret == OK) ? "OK" : "ERROR");
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
ret = TRANSITION_CHANGED; |
|
|
|
|
mavlink_log_critical(mavlink_fd, "Switched to ON hil state"); |
|
|
|
|