Modification to CSI

Signed-off-by: Phi Bang Nguyen <[email protected]>

Author: ngphibang

drivers/video/video_mcux_csi.c

@@ -19,6 +19,7 @@
 #include <fsl_cache.h>
 #endif
 
+#include "video_buffer.h"
 #include "video_device.h"
 
 struct video_mcux_csi_config {
@@ -69,8 +70,11 @@ static void __frame_done_cb(CSI_Type *base, csi_handle_t *handle, status_t statu
 
 	// k_fifo_put(&data->fifo_out, vbuf);
 
-	struct mpsc_node *node = mpsc_pop(&data->io_q);
-	struct rtio_iodev_sqe *iodev_sqe = CONTAINER_OF(node, struct rtio_iodev_sqe, q);
+	struct rtio_iodev_sqe *iodev_sqe = video_pop_io_q(&data->io_q);
+
+	if (iodev_sqe == NULL) {
+		return;
+	}
 
 	rtio_iodev_sqe_ok(iodev_sqe, 0);