diff --git a/src/drivers/px4io/px4io.cpp b/src/drivers/px4io/px4io.cpp index 7694850181..507211caad 100644 --- a/src/drivers/px4io/px4io.cpp +++ b/src/drivers/px4io/px4io.cpp @@ -2973,10 +2973,7 @@ get_interface() #ifndef CONFIG_ARCH_BOARD_PX4FMU_V1 #ifdef PX4IO_SERIAL_BASE - /* try for a serial interface */ - if (PX4IO_serial_interface != nullptr) { - interface = PX4IO_serial_interface(); - } + interface = PX4IO_serial_interface(); #endif if (interface != nullptr) { @@ -2986,10 +2983,7 @@ get_interface() #endif #ifdef PX4_I2C_OBDEV_PX4IO - /* try for an I2C interface if we haven't got a serial one */ - if (PX4IO_i2c_interface != nullptr) { - interface = PX4IO_i2c_interface(); - } + interface = PX4IO_i2c_interface(); #endif if (interface != nullptr) { diff --git a/src/drivers/px4io/px4io_serial.cpp b/src/drivers/px4io/px4io_serial.cpp index 344b1affa3..2c38c0dd3c 100644 --- a/src/drivers/px4io/px4io_serial.cpp +++ b/src/drivers/px4io/px4io_serial.cpp @@ -39,6 +39,7 @@ /* XXX trim includes */ #include +#include #include #include @@ -177,8 +178,8 @@ PX4IO_serial::PX4IO_serial() : _tx_dma(nullptr), _rx_dma(nullptr), _rx_dma_status(_dma_status_inactive), - _bus_semaphore(px4_sem_initIALIZER(0)), - _completion_semaphore(px4_sem_initIALIZER(0)), + _bus_semaphore(SEM_INITIALIZER(0)), + _completion_semaphore(SEM_INITIALIZER(0)), _pc_txns(perf_alloc(PC_ELAPSED, "io_txns ")), _pc_dmasetup(perf_alloc(PC_ELAPSED, "io_dmasetup ")), _pc_retries(perf_alloc(PC_COUNT, "io_retries ")), @@ -551,7 +552,7 @@ PX4IO_serial::_wait_complete() int ret; for (;;) { - ret = px4_sem_timedwait(&_completion_semaphore, &abstime); + ret = sem_timedwait(&_completion_semaphore, &abstime); if (ret == OK) { /* check for DMA errors */