Browse Source

REVERT THIS COMMIT LATER: Temporarily disable the device listing

sbg
Lorenz Meier 9 years ago
parent
commit
cc8f159bcc
  1. 15
      src/drivers/device/vdev.cpp
  2. 42
      src/modules/commander/state_machine_helper.cpp

15
src/drivers/device/vdev.cpp

@ -550,13 +550,14 @@ void VDev::showDevices() @@ -550,13 +550,14 @@ void VDev::showDevices()
pthread_mutex_unlock(&devmutex);
PX4_INFO("DF Devices:");
std::string devname;
for (unsigned int index=0; i == 0; ++i) {
if (DevMgr::getNextDeviceName(index, devname) == 0) {
PX4_INFO(" %s", devname.c_str());
}
}
// TODO NOT IMPLEMENTED
// std::string devname;
// for (unsigned int index=0; i == 0; ++i) {
// if (DevMgr::getNextDeviceName(index, devname) == 0) {
// PX4_INFO(" %s", devname.c_str());
// }
// }
}
void VDev::showTopics()

42
src/modules/commander/state_machine_helper.cpp

@ -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");

Loading…
Cancel
Save