This commit is contained in:
Kamil Trzcinski
2022-04-04 16:05:32 +02:00
parent 3c4457076b
commit b83a7f3728
5 changed files with 156 additions and 77 deletions

99
main.c
View File

@@ -21,7 +21,7 @@ int open_camera(const char *path)
return -1;
}
if (device_open_buffer_list(camera, true, camera_width, camera_height, camera_format, camera_nbufs) < 0) {
if (device_open_buffer_list(camera, true, camera_width, camera_height, camera_format, camera_nbufs, true) < 0) {
return -1;
}
@@ -38,9 +38,9 @@ int open_isp(buffer_list_t *src, const char *srgb_path, const char *yuuv_path, c
return -1;
}
if (device_open_buffer_list(isp_srgb, false, src->fmt_width, src->fmt_height, src->fmt_format, camera_nbufs) < 0 ||
device_open_buffer_list(isp_yuuv, true, src->fmt_width, src->fmt_height, V4L2_PIX_FMT_YUYV, camera_nbufs) < 0 ||
device_open_buffer_list(isp_yuuv_low, true, src->fmt_width / 2, src->fmt_height / 2, V4L2_PIX_FMT_YUYV, camera_nbufs) < 0) {
if (device_open_buffer_list(isp_srgb, false, src->fmt_width, src->fmt_height, src->fmt_format, camera_nbufs, true) < 0 ||
device_open_buffer_list(isp_yuuv, true, src->fmt_width, src->fmt_height, V4L2_PIX_FMT_YUYV, camera_nbufs, true) < 0 ||
device_open_buffer_list(isp_yuuv_low, true, src->fmt_width / 2, src->fmt_height / 2, V4L2_PIX_FMT_YUYV, camera_nbufs, true) < 0) {
return -1;
}
@@ -54,14 +54,54 @@ int open_jpeg(buffer_list_t *src, const char *jpeg_codec)
return -1;
}
if (device_open_buffer_list(codec_jpeg, false, src->fmt_width, src->fmt_height, src->fmt_format, camera_nbufs) < 0 ||
device_open_buffer_list(codec_jpeg, true, src->fmt_width, src->fmt_height, V4L2_PIX_FMT_JPEG, camera_nbufs) < 0) {
if (device_open_buffer_list(codec_jpeg, false, src->fmt_width, src->fmt_height, src->fmt_format, camera_nbufs, false) < 0 ||
device_open_buffer_list(codec_jpeg, true, src->fmt_width, src->fmt_height, V4L2_PIX_FMT_JPEG, camera_nbufs, false) < 0) {
return -1;
}
return 0;
}
void connect_links(device_t **links) {
buffer_t *buf, *output_buf;
device_t *src = links[0];
if (src->capture_list->do_mmap) {
if (buffer_list_wait_pool(src->capture_list, 100, true)) {
if (buf = buffer_list_dequeue(src->capture_list, true)) {
for (int i = 1; links[i]; i++) {
buffer_list_enqueue(links[i]->output_list, buf);
if (buffer_list_wait_pool(links[i]->output_list, 10, false)) {
// consume dma-bufs
if (output_buf = buffer_list_dequeue(links[i]->output_list, false)) {
buffer_consumed(output_buf);
}
}
}
buffer_consumed(buf);
}
}
} else {
for (int i = 1; links[i]; i++) {
if (buffer_list_wait_pool(links[i]->output_list, 100, true)) {
if (output_buf = buffer_list_dequeue(links[i]->output_list, true)) {
buffer_list_enqueue(src->capture_list, output_buf);
buffer_consumed(output_buf);
}
}
}
// consume dma-bufs
if (buffer_list_wait_pool(src->capture_list, 100, false)) {
if (buf = buffer_list_dequeue(src->capture_list, false)) {
buffer_consumed(output_buf);
}
}
}
}
int main(int argc, char *argv[])
{
if (open_camera("/dev/video0") < 0) {
@@ -92,33 +132,28 @@ int main(int argc, char *argv[])
goto error;
}
device_t *links[][10] = {
{
camera,
isp_srgb,
NULL
}, {
isp_yuuv,
codec_jpeg,
NULL
}, {
isp_yuuv_low,
NULL
}, {
codec_jpeg,
NULL
},
NULL
};
while(true) {
buffer_t *buf;
if (buffer_list_wait_pool(camera->capture_list, 100)) {
if (buf = buffer_list_mmap_dequeue(camera->capture_list)) {
buffer_list_mmap_enqueue(isp_srgb->output_list, buf);
buffer_consumed(buf);
}
}
if (buffer_list_wait_pool(isp_yuuv->capture_list, 100)) {
if (buf = buffer_list_mmap_dequeue(isp_yuuv->capture_list)) {
buffer_list_mmap_enqueue(codec_jpeg->output_list, buf);
buffer_consumed(buf);
}
}
if (buffer_list_wait_pool(isp_yuuv_low->capture_list, 100)) {
if (buf = buffer_list_mmap_dequeue(isp_yuuv_low->capture_list)) {
buffer_consumed(buf);
}
}
if (buffer_list_wait_pool(codec_jpeg->capture_list, 100)) {
if (buf = buffer_list_mmap_dequeue(codec_jpeg->capture_list)) {
buffer_consumed(buf);
}
for (int i = 0; links[i] && links[i][0]; i++) {
connect_links(links[i]);
}
usleep(100*1000);