1 files changed, 303 insertions, 0 deletions
diff --git a/freedreno/msm/msm_ringbuffer.c b/freedreno/msm/msm_ringbuffer.c
new file mode 100644
index 00000000..fc5193ae
--- /dev/null
+++ b/freedreno/msm/msm_ringbuffer.c
@@ -0,0 +1,303 @@
+/* -*- mode: C; c-file-style: "k&r"; tab-width 4; indent-tabs-mode: t; -*- */
+
+/*
+ * Copyright (C) 2013 Rob Clark <robclark@freedesktop.org>
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice (including the next
+ * paragraph) shall be included in all copies or substantial portions of the
+ * Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
+ *
+ * Authors:
+ *    Rob Clark <robclark@freedesktop.org>
+ */
+
+#include <assert.h>
+
+#include "freedreno_ringbuffer.h"
+#include "msm_priv.h"
+
+struct msm_ringbuffer {
+	struct fd_ringbuffer base;
+	struct fd_bo *ring_bo;
+
+	struct list_head submit_list;
+
+	/* bo's table: */
+	struct drm_msm_gem_submit_bo *bos;
+	uint32_t nr_bos, max_bos;
+
+	/* cmd's table: */
+	struct drm_msm_gem_submit_cmd *cmds;
+	uint32_t nr_cmds, max_cmds;
+
+	/* reloc's table: */
+	struct drm_msm_gem_submit_reloc *relocs;
+	uint32_t nr_relocs, max_relocs;
+};
+
+static void *grow(void *ptr, uint32_t nr, uint32_t *max, uint32_t sz)
+{
+	if ((nr + 1) > *max) {
+		if ((*max * 2) < (nr + 1))
+			*max = nr + 5;
+		else
+			*max = *max * 2;
+		ptr = realloc(ptr, *max * sz);
+	}
+	return ptr;
+}
+
+#define APPEND(x, name) ({ \
+	(x)->name = grow((x)->name, (x)->nr_ ## name, &(x)->max_ ## name, sizeof((x)->name[0])); \
+	(x)->nr_ ## name ++; \
+})
+
+static inline struct msm_ringbuffer * to_msm_ringbuffer(struct fd_ringbuffer *x)
+{
+	return (struct msm_ringbuffer *)x;
+}
+
+/* add (if needed) bo, return idx: */
+static uint32_t bo2idx(struct fd_ringbuffer *ring, struct fd_bo *bo, uint32_t flags)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	struct msm_bo *msm_bo = to_msm_bo(bo);
+	int id = ring->pipe->id;
+	uint32_t idx;
+	if (!msm_bo->indexp1[id]) {
+		struct list_head *list = &msm_bo->list[id];
+		idx = APPEND(msm_ring, bos);
+		msm_ring->bos[idx].flags = 0;
+		msm_ring->bos[idx].handle = bo->handle;
+		msm_ring->bos[idx].presumed = msm_bo->presumed;
+		msm_bo->indexp1[id] = idx + 1;
+
+		assert(LIST_IS_EMPTY(list));
+		fd_bo_ref(bo);
+		list_addtail(list, &msm_ring->submit_list);
+	} else {
+		idx = msm_bo->indexp1[id] - 1;
+	}
+	if (flags & FD_RELOC_READ)
+		msm_ring->bos[idx].flags |= MSM_SUBMIT_BO_READ;
+	if (flags & FD_RELOC_WRITE)
+		msm_ring->bos[idx].flags |= MSM_SUBMIT_BO_WRITE;
+	return idx;
+}
+
+static uint32_t offset_bytes(void *end, void *start)
+{
+	return ((char *)end) - ((char *)start);
+}
+
+static struct drm_msm_gem_submit_cmd * get_cmd(struct fd_ringbuffer *ring,
+		struct fd_bo *ring_bo, uint32_t submit_offset, uint32_t size, uint32_t type)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	struct drm_msm_gem_submit_cmd *cmd = NULL;
+	uint32_t i;
+
+	/* figure out if we already have a cmd buf: */
+	for (i = 0; i < msm_ring->nr_cmds; i++) {
+		cmd = &msm_ring->cmds[i];
+		if ((cmd->submit_offset == submit_offset) &&
+				(cmd->size == size) &&
+				(cmd->type == type))
+			break;
+		cmd = NULL;
+	}
+
+	/* create cmd buf if not: */
+	if (!cmd) {
+		uint32_t idx = APPEND(msm_ring, cmds);
+		cmd = &msm_ring->cmds[idx];
+		cmd->type = type;
+		cmd->submit_idx = bo2idx(ring, ring_bo, FD_RELOC_READ);
+		cmd->submit_offset = submit_offset;
+		cmd->size = size;
+	}
+
+	return cmd;
+}
+
+static void * msm_ringbuffer_hostptr(struct fd_ringbuffer *ring)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	return fd_bo_map(msm_ring->ring_bo);
+}
+
+static uint32_t find_next_reloc_idx(struct msm_ringbuffer *msm_ring,
+		uint32_t start, uint32_t offset)
+{
+	uint32_t i;
+
+	/* a binary search would be more clever.. */
+	for (i = start; i < msm_ring->nr_relocs; i++) {
+		struct drm_msm_gem_submit_reloc *reloc = &msm_ring->relocs[i];
+		if (reloc->submit_offset >= offset)
+			return i;
+	}
+
+	return i;
+}
+
+static int msm_ringbuffer_flush(struct fd_ringbuffer *ring, uint32_t *last_start)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	struct fd_bo *ring_bo = msm_ring->ring_bo;
+	struct drm_msm_gem_submit req = {
+			.pipe = to_msm_pipe(ring->pipe)->pipe,
+	};
+	struct msm_bo *msm_bo = NULL, *tmp;
+	uint32_t i, submit_offset, size;
+	int ret, id = ring->pipe->id;
+
+	submit_offset = offset_bytes(last_start, ring->start);
+	size = offset_bytes(ring->cur, last_start);
+
+	get_cmd(ring, ring_bo, submit_offset, size, MSM_SUBMIT_CMD_BUF);
+
+	/* needs to be after get_cmd() as that could create bos/cmds table: */
+	req.bos = VOID2U64(msm_ring->bos),
+	req.nr_bos = msm_ring->nr_bos;
+	req.cmds = VOID2U64(msm_ring->cmds),
+	req.nr_cmds = msm_ring->nr_cmds;
+
+	/* for each of the cmd's fix up their reloc's: */
+	for (i = 0; i < msm_ring->nr_cmds; i++) {
+		struct drm_msm_gem_submit_cmd *cmd = &msm_ring->cmds[i];
+		uint32_t a = find_next_reloc_idx(msm_ring, 0, cmd->submit_offset);
+		uint32_t b = find_next_reloc_idx(msm_ring, a, cmd->submit_offset + cmd->size);
+		cmd->relocs = VOID2U64(&msm_ring->relocs[a]);
+		cmd->nr_relocs = (b > a) ? b - a : 0;
+	}
+
+	DEBUG_MSG("nr_cmds=%u, nr_bos=%u\n", req.nr_cmds, req.nr_bos);
+
+	ret = drmCommandWriteRead(ring->pipe->dev->fd, DRM_MSM_GEM_SUBMIT,
+			&req, sizeof(req));
+	if (ret)
+		ERROR_MSG("submit failed: %d (%s)", ret, strerror(errno));
+
+	LIST_FOR_EACH_ENTRY_SAFE(msm_bo, tmp, &msm_ring->submit_list, list[id]) {
+		struct list_head *list = &msm_bo->list[id];
+		list_delinit(list);
+		msm_bo->indexp1[id] = 0;
+		fd_bo_del(&msm_bo->base);
+	}
+
+	msm_ring->nr_cmds = 0;
+	msm_ring->nr_relocs = 0;
+	msm_ring->nr_bos = 0;
+
+	return ret;
+}
+
+static void msm_ringbuffer_emit_reloc(struct fd_ringbuffer *ring,
+		const struct fd_reloc *r)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	struct msm_bo *msm_bo = to_msm_bo(r->bo);
+	struct drm_msm_gem_submit_reloc *reloc;
+	uint32_t idx = APPEND(msm_ring, relocs);
+	uint32_t addr;
+
+	reloc = &msm_ring->relocs[idx];
+
+	reloc->reloc_idx = bo2idx(ring, r->bo, r->flags);
+	reloc->reloc_offset = r->offset;
+	reloc->or = r->or;
+	reloc->shift = r->shift;
+	reloc->submit_offset = offset_bytes(ring->cur, ring->start);
+
+	addr = msm_bo->presumed;
+	if (r->shift < 0)
+		addr >>= -r->shift;
+	else
+		addr <<= r->shift;
+	(*ring->cur++) = addr | r->or;
+}
+
+static void msm_ringbuffer_emit_reloc_ring(struct fd_ringbuffer *ring,
+		struct fd_ringmarker *target, struct fd_ringmarker *end)
+{
+	struct fd_bo *ring_bo = to_msm_ringbuffer(target->ring)->ring_bo;
+	struct drm_msm_gem_submit_cmd *cmd;
+	uint32_t submit_offset, size;
+
+	submit_offset = offset_bytes(target->cur, target->ring->start);
+	size = offset_bytes(end->cur, target->cur);
+
+	assert(target->ring == ring);  // TODO
+
+	cmd = get_cmd(ring, ring_bo, submit_offset, size,
+			MSM_SUBMIT_CMD_IB_TARGET_BUF);
+	assert(cmd);
+
+	msm_ringbuffer_emit_reloc(ring, &(struct fd_reloc){
+		.bo = ring_bo,
+		.flags = FD_RELOC_READ,
+		.offset = submit_offset,
+	});
+}
+
+static void msm_ringbuffer_destroy(struct fd_ringbuffer *ring)
+{
+	struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring);
+	if (msm_ring->ring_bo)
+		fd_bo_del(msm_ring->ring_bo);
+	free(msm_ring);
+}
+
+static struct fd_ringbuffer_funcs funcs = {
+		.hostptr = msm_ringbuffer_hostptr,
+		.flush = msm_ringbuffer_flush,
+		.emit_reloc = msm_ringbuffer_emit_reloc,
+		.emit_reloc_ring = msm_ringbuffer_emit_reloc_ring,
+		.destroy = msm_ringbuffer_destroy,
+};
+
+struct fd_ringbuffer * msm_ringbuffer_new(struct fd_pipe *pipe,
+		uint32_t size)
+{
+	struct msm_ringbuffer *msm_ring;
+	struct fd_ringbuffer *ring = NULL;
+
+	msm_ring = calloc(1, sizeof(*msm_ring));
+	if (!msm_ring) {
+		ERROR_MSG("allocation failed");
+		goto fail;
+	}
+
+	ring = &msm_ring->base;
+	ring->funcs = &funcs;
+
+	list_inithead(&msm_ring->submit_list);
+
+	msm_ring->ring_bo = fd_bo_new(pipe->dev, size, 0);
+	if (!msm_ring->ring_bo) {
+		ERROR_MSG("ringbuffer allocation failed");
+		goto fail;
+	}
+
+	return ring;
+fail:
+	if (ring)
+		fd_ringbuffer_del(ring);
+	return NULL;
+}