1 files changed, 80 insertions, 0 deletions
diff --git a/isp/v4l2-pool.c b/isp/v4l2-pool.c
new file mode 100644
index 0000000..b0bf3b5
--- /dev/null
+++ b/isp/v4l2-pool.c
@@ -0,0 +1,80 @@
+/*
+ * OMAP3 ISP library - V4L2 buffers pool
+ *
+ * Copyright (C) 2010-2011 Ideas on board SPRL
+ *
+ * Contact: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
+ *
+ * This library is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU Lesser General Public License as published by
+ * the Free Software Foundation; either version 2.1 of the License, or (at
+ * your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public License
+ * along with this library; if not, write to the Free Software Foundation,
+ * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#include <stdlib.h>
+#include <string.h>
+
+#include "v4l2-pool.h"
+
+struct v4l2_buffers_pool *v4l2_buffers_pool_new(unsigned int nbufs)
+{
+	struct v4l2_video_buffer *buffers;
+	struct v4l2_buffers_pool *pool;
+
+	pool = malloc(sizeof *pool);
+	if (pool == NULL)
+		return NULL;
+
+	buffers = malloc(sizeof *buffers * nbufs);
+	if (buffers == NULL) {
+		free(pool);
+		return NULL;
+	}
+
+	memset(buffers, 0, sizeof *buffers * nbufs);
+
+	pool->nbufs = nbufs;
+	pool->buffers = buffers;
+
+	return pool;
+}
+
+void v4l2_buffers_pool_delete(struct v4l2_buffers_pool *pool)
+{
+	unsigned int i;
+
+	for (i = 0; i < pool->nbufs; ++i) {
+		if (pool->buffers[i].allocated)
+			free(pool->buffers[i].mem);
+	}
+
+	free(pool->buffers);
+	free(pool);
+}
+
+int v4l2_buffers_pool_alloc(struct v4l2_buffers_pool *pool, size_t size,
+			    size_t align)
+{
+	unsigned int i;
+	int ret;
+
+	for (i = 0; i < pool->nbufs; ++i) {
+		ret = posix_memalign(&pool->buffers[i].mem, align, size);
+		if (ret != 0)
+			return -ret;
+
+		pool->buffers[i].size = size;
+		pool->buffers[i].allocated = true;
+	}
+
+	return 0;
+}