| /* -*- 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> |
| */ |
| |
| #ifdef HAVE_CONFIG_H |
| # include <config.h> |
| #endif |
| |
| #include <assert.h> |
| #include <inttypes.h> |
| |
| #include "freedreno_ringbuffer.h" |
| #include "msm_priv.h" |
| |
| struct msm_ringbuffer { |
| struct fd_ringbuffer base; |
| struct fd_bo *ring_bo; |
| |
| /* submit ioctl related tables: */ |
| struct { |
| /* 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; |
| } submit; |
| |
| /* should have matching entries in submit.bos: */ |
| struct fd_bo **bos; |
| uint32_t nr_bos, max_bos; |
| |
| /* should have matching entries in submit.cmds: */ |
| struct fd_ringbuffer **rings; |
| uint32_t nr_rings, max_rings; |
| }; |
| |
| static pthread_mutex_t idx_lock = PTHREAD_MUTEX_INITIALIZER; |
| |
| 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; |
| } |
| |
| static uint32_t append_bo(struct fd_ringbuffer *ring, struct fd_bo *bo) |
| { |
| struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring); |
| uint32_t idx; |
| |
| idx = APPEND(&msm_ring->submit, bos); |
| idx = APPEND(msm_ring, bos); |
| |
| msm_ring->submit.bos[idx].flags = 0; |
| msm_ring->submit.bos[idx].handle = bo->handle; |
| msm_ring->submit.bos[idx].presumed = to_msm_bo(bo)->presumed; |
| |
| msm_ring->bos[idx] = fd_bo_ref(bo); |
| |
| return idx; |
| } |
| |
| /* 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); |
| uint32_t idx; |
| pthread_mutex_lock(&idx_lock); |
| if (!msm_bo->current_ring) { |
| idx = append_bo(ring, bo); |
| msm_bo->current_ring = ring; |
| msm_bo->idx = idx; |
| } else if (msm_bo->current_ring == ring) { |
| idx = msm_bo->idx; |
| } else { |
| /* slow-path: */ |
| for (idx = 0; idx < msm_ring->nr_bos; idx++) |
| if (msm_ring->bos[idx] == bo) |
| break; |
| if (idx == msm_ring->nr_bos) { |
| /* not found */ |
| idx = append_bo(ring, bo); |
| } |
| } |
| pthread_mutex_unlock(&idx_lock); |
| if (flags & FD_RELOC_READ) |
| msm_ring->submit.bos[idx].flags |= MSM_SUBMIT_BO_READ; |
| if (flags & FD_RELOC_WRITE) |
| msm_ring->submit.bos[idx].flags |= MSM_SUBMIT_BO_WRITE; |
| return idx; |
| } |
| |
| static int check_cmd_bo(struct fd_ringbuffer *ring, |
| struct drm_msm_gem_submit_cmd *cmd, struct fd_bo *bo) |
| { |
| struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring); |
| return msm_ring->submit.bos[cmd->submit_idx].handle == bo->handle; |
| } |
| |
| 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_ringbuffer *target_ring, struct fd_bo *target_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->submit.nr_cmds; i++) { |
| cmd = &msm_ring->submit.cmds[i]; |
| if ((cmd->submit_offset == submit_offset) && |
| (cmd->size == size) && |
| (cmd->type == type) && |
| check_cmd_bo(ring, cmd, target_bo)) |
| break; |
| cmd = NULL; |
| } |
| |
| /* create cmd buf if not: */ |
| if (!cmd) { |
| uint32_t idx = APPEND(&msm_ring->submit, cmds); |
| APPEND(msm_ring, rings); |
| msm_ring->rings[idx] = target_ring; |
| cmd = &msm_ring->submit.cmds[idx]; |
| cmd->type = type; |
| cmd->submit_idx = bo2idx(ring, target_bo, FD_RELOC_READ); |
| cmd->submit_offset = submit_offset; |
| cmd->size = size; |
| cmd->pad = 0; |
| } |
| |
| 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->submit.nr_relocs; i++) { |
| struct drm_msm_gem_submit_reloc *reloc = &msm_ring->submit.relocs[i]; |
| if (reloc->submit_offset >= offset) |
| return i; |
| } |
| |
| return i; |
| } |
| |
| static void flush_reset(struct fd_ringbuffer *ring) |
| { |
| struct msm_ringbuffer *msm_ring = to_msm_ringbuffer(ring); |
| unsigned i; |
| |
| /* for each of the cmd buffers, clear their reloc's: */ |
| for (i = 0; i < msm_ring->submit.nr_cmds; i++) { |
| struct msm_ringbuffer *target_ring = to_msm_ringbuffer(msm_ring->rings[i]); |
| target_ring->submit.nr_relocs = 0; |
| } |
| |
| msm_ring->submit.nr_relocs = 0; |
| msm_ring->submit.nr_cmds = 0; |
| msm_ring->submit.nr_bos = 0; |
| msm_ring->nr_rings = 0; |
| msm_ring->nr_bos = 0; |
| } |
| |
| 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, |
| }; |
| uint32_t i, j, submit_offset, size; |
| int ret; |
| |
| submit_offset = offset_bytes(last_start, ring->start); |
| size = offset_bytes(ring->cur, last_start); |
| |
| get_cmd(ring, 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->submit.bos), |
| req.nr_bos = msm_ring->submit.nr_bos; |
| req.cmds = VOID2U64(msm_ring->submit.cmds), |
| req.nr_cmds = msm_ring->submit.nr_cmds; |
| |
| /* for each of the cmd's fix up their reloc's: */ |
| for (i = 0; i < msm_ring->submit.nr_cmds; i++) { |
| struct drm_msm_gem_submit_cmd *cmd = &msm_ring->submit.cmds[i]; |
| struct msm_ringbuffer *target_ring = to_msm_ringbuffer(msm_ring->rings[i]); |
| uint32_t a = find_next_reloc_idx(target_ring, 0, cmd->submit_offset); |
| uint32_t b = find_next_reloc_idx(target_ring, a, cmd->submit_offset + cmd->size); |
| cmd->relocs = VOID2U64(&target_ring->submit.relocs[a]); |
| cmd->nr_relocs = (b > a) ? b - a : 0; |
| } |
| |
| DEBUG_MSG("nr_cmds=%u, nr_bos=%u", 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)); |
| ERROR_MSG(" pipe: %u", req.pipe); |
| for (i = 0; i < msm_ring->submit.nr_bos; i++) { |
| struct drm_msm_gem_submit_bo *bo = &msm_ring->submit.bos[i]; |
| ERROR_MSG(" bos[%d]: handle=%u, flags=%x", i, bo->handle, bo->flags); |
| } |
| for (i = 0; i < msm_ring->submit.nr_cmds; i++) { |
| struct drm_msm_gem_submit_cmd *cmd = &msm_ring->submit.cmds[i]; |
| struct drm_msm_gem_submit_reloc *relocs = U642VOID(cmd->relocs); |
| ERROR_MSG(" cmd[%d]: type=%u, submit_idx=%u, submit_offset=%u, size=%u", |
| i, cmd->type, cmd->submit_idx, cmd->submit_offset, cmd->size); |
| for (j = 0; j < cmd->nr_relocs; j++) { |
| struct drm_msm_gem_submit_reloc *r = &relocs[j]; |
| ERROR_MSG(" reloc[%d]: submit_offset=%u, or=%08x, shift=%d, reloc_idx=%u" |
| ", reloc_offset=%"PRIu64, j, r->submit_offset, r->or, r->shift, |
| r->reloc_idx, r->reloc_offset); |
| } |
| } |
| } else { |
| /* update timestamp on all rings associated with submit: */ |
| for (i = 0; i < msm_ring->submit.nr_cmds; i++) { |
| struct fd_ringbuffer *target_ring = msm_ring->rings[i]; |
| if (!ret) |
| target_ring->last_timestamp = req.fence; |
| } |
| } |
| |
| for (i = 0; i < msm_ring->nr_bos; i++) { |
| struct msm_bo *msm_bo = to_msm_bo(msm_ring->bos[i]); |
| msm_bo->current_ring = NULL; |
| fd_bo_del(&msm_bo->base); |
| } |
| |
| flush_reset(ring); |
| |
| return ret; |
| } |
| |
| static void msm_ringbuffer_reset(struct fd_ringbuffer *ring) |
| { |
| flush_reset(ring); |
| } |
| |
| 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 fd_ringbuffer *parent = ring->parent ? ring->parent : ring; |
| struct msm_bo *msm_bo = to_msm_bo(r->bo); |
| struct drm_msm_gem_submit_reloc *reloc; |
| uint32_t idx = APPEND(&msm_ring->submit, relocs); |
| uint32_t addr; |
| |
| reloc = &msm_ring->submit.relocs[idx]; |
| |
| reloc->reloc_idx = bo2idx(parent, 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 *target_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); |
| |
| cmd = get_cmd(ring, target->ring, target_bo, submit_offset, size, |
| MSM_SUBMIT_CMD_IB_TARGET_BUF); |
| assert(cmd); |
| |
| msm_ringbuffer_emit_reloc(ring, &(struct fd_reloc){ |
| .bo = target_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->submit.relocs); |
| free(msm_ring->submit.cmds); |
| free(msm_ring->submit.bos); |
| free(msm_ring->bos); |
| free(msm_ring->rings); |
| free(msm_ring); |
| } |
| |
| static const struct fd_ringbuffer_funcs funcs = { |
| .hostptr = msm_ringbuffer_hostptr, |
| .flush = msm_ringbuffer_flush, |
| .reset = msm_ringbuffer_reset, |
| .emit_reloc = msm_ringbuffer_emit_reloc, |
| .emit_reloc_ring = msm_ringbuffer_emit_reloc_ring, |
| .destroy = msm_ringbuffer_destroy, |
| }; |
| |
| drm_private 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; |
| |
| 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; |
| } |