mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-02 02:31:36 +08:00
commander: Restructure ifdef logic for POSIX build to keep NuttX and POSIX implementations aligned
This commit is contained in:
@@ -451,43 +451,47 @@ transition_result_t hil_state_transition(hil_state_t new_state, orb_advert_t sta
|
|||||||
}
|
}
|
||||||
closedir(d);
|
closedir(d);
|
||||||
|
|
||||||
#else
|
|
||||||
|
|
||||||
const char *devname;
|
|
||||||
unsigned int handle = 0;
|
|
||||||
for(;;) {
|
|
||||||
devname = px4_get_device_names(&handle);
|
|
||||||
if (devname == NULL)
|
|
||||||
break;
|
|
||||||
|
|
||||||
/* skip mavlink */
|
|
||||||
if (!strcmp("/dev/mavlink", devname)) {
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
int sensfd = px4_open(devname, 0);
|
|
||||||
|
|
||||||
if (sensfd < 0) {
|
|
||||||
warn("failed opening device %s", devname);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
int block_ret = px4_ioctl(sensfd, DEVIOCSPUBBLOCK, 1);
|
|
||||||
px4_close(sensfd);
|
|
||||||
|
|
||||||
printf("Disabling %s: %s\n", devname, (block_ret == OK) ? "OK" : "ERROR");
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
ret = TRANSITION_CHANGED;
|
ret = TRANSITION_CHANGED;
|
||||||
mavlink_log_critical(mavlink_fd, "Switched to ON hil state");
|
mavlink_log_critical(mavlink_fd, "Switched to ON hil state");
|
||||||
|
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
/* failed opening dir */
|
/* failed opening dir */
|
||||||
mavlink_log_info(mavlink_fd, "FAILED LISTING DEVICE ROOT DIRECTORY");
|
mavlink_log_info(mavlink_fd, "FAILED LISTING DEVICE ROOT DIRECTORY");
|
||||||
ret = TRANSITION_DENIED;
|
ret = TRANSITION_DENIED;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#else
|
||||||
|
|
||||||
|
const char *devname;
|
||||||
|
unsigned int handle = 0;
|
||||||
|
for(;;) {
|
||||||
|
devname = px4_get_device_names(&handle);
|
||||||
|
if (devname == NULL)
|
||||||
|
break;
|
||||||
|
|
||||||
|
/* skip mavlink */
|
||||||
|
if (!strcmp("/dev/mavlink", devname)) {
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int sensfd = px4_open(devname, 0);
|
||||||
|
|
||||||
|
if (sensfd < 0) {
|
||||||
|
warn("failed opening device %s", devname);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
int block_ret = px4_ioctl(sensfd, DEVIOCSPUBBLOCK, 1);
|
||||||
|
px4_close(sensfd);
|
||||||
|
|
||||||
|
printf("Disabling %s: %s\n", devname, (block_ret == OK) ? "OK" : "ERROR");
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = TRANSITION_CHANGED;
|
||||||
|
mavlink_log_critical(mavlink_fd, "Switched to ON hil state");
|
||||||
|
#endif
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
mavlink_log_critical(mavlink_fd, "Not switching to HIL when armed");
|
mavlink_log_critical(mavlink_fd, "Not switching to HIL when armed");
|
||||||
ret = TRANSITION_DENIED;
|
ret = TRANSITION_DENIED;
|
||||||
|
|||||||
Reference in New Issue
Block a user