Orange Pi5 kernel

/*
 * Copyright 2011 Red Hat Inc.
 * All Rights Reserved.
 *
 * 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, sub license, 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 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 NON-INFRINGEMENT. IN NO EVENT SHALL
 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS 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.
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial portions
 * of the Software.
 *
 */
/*
 * Authors:
 *    Jerome Glisse <glisse@freedesktop.org>
 */
/* Algorithm:
 *
 * We store the last allocated bo in "hole", we always try to allocate
 * after the last allocated bo. Principle is that in a linear GPU ring
 * progression was is after last is the oldest bo we allocated and thus
 * the first one that should no longer be in use by the GPU.
 *
 * If it's not the case we skip over the bo after last to the closest
 * done bo if such one exist. If none exist and we are not asked to
 * block we report failure to allocate.
 *
 * If we are asked to block we wait on all the oldest fence of all
 * rings. We just wait for any of those fence to complete.
 */
 
#include "radeon.h"
 
static void radeon_sa_bo_remove_locked(struct radeon_sa_bo *sa_bo);
static void radeon_sa_bo_try_free(struct radeon_sa_manager *sa_manager);
 
int radeon_sa_bo_manager_init(struct radeon_device *rdev,
<------><------><------>      struct radeon_sa_manager *sa_manager,
<------><------><------>      unsigned size, u32 align, u32 domain, u32 flags)
{
<------>int i, r;
 
<------>init_waitqueue_head(&sa_manager->wq);
<------>sa_manager->bo = NULL;
<------>sa_manager->size = size;
<------>sa_manager->domain = domain;
<------>sa_manager->align = align;
<------>sa_manager->hole = &sa_manager->olist;
<------>INIT_LIST_HEAD(&sa_manager->olist);
<------>for (i = 0; i < RADEON_NUM_RINGS; ++i) {
<------><------>INIT_LIST_HEAD(&sa_manager->flist[i]);
<------>}
 
<------>r = radeon_bo_create(rdev, size, align, true,
<------><------><------>     domain, flags, NULL, NULL, &sa_manager->bo);
<------>if (r) {
<------><------>dev_err(rdev->dev, "(%d) failed to allocate bo for manager\n", r);
<------><------>return r;
<------>}
 
<------>return r;
}
 
void radeon_sa_bo_manager_fini(struct radeon_device *rdev,
<------><------><------>       struct radeon_sa_manager *sa_manager)
{
<------>struct radeon_sa_bo *sa_bo, *tmp;
 
<------>if (!list_empty(&sa_manager->olist)) {
<------><------>sa_manager->hole = &sa_manager->olist,
<------><------>radeon_sa_bo_try_free(sa_manager);
<------><------>if (!list_empty(&sa_manager->olist)) {
<------><------><------>dev_err(rdev->dev, "sa_manager is not empty, clearing anyway\n");
<------><------>}
<------>}
<------>list_for_each_entry_safe(sa_bo, tmp, &sa_manager->olist, olist) {
<------><------>radeon_sa_bo_remove_locked(sa_bo);
<------>}
<------>radeon_bo_unref(&sa_manager->bo);
<------>sa_manager->size = 0;
}
 
int radeon_sa_bo_manager_start(struct radeon_device *rdev,
<------><------><------>       struct radeon_sa_manager *sa_manager)
{
<------>int r;
 
<------>if (sa_manager->bo == NULL) {
<------><------>dev_err(rdev->dev, "no bo for sa manager\n");
<------><------>return -EINVAL;
<------>}
 
<------>/* map the buffer */
<------>r = radeon_bo_reserve(sa_manager->bo, false);
<------>if (r) {
<------><------>dev_err(rdev->dev, "(%d) failed to reserve manager bo\n", r);
<------><------>return r;
<------>}
<------>r = radeon_bo_pin(sa_manager->bo, sa_manager->domain, &sa_manager->gpu_addr);
<------>if (r) {
<------><------>radeon_bo_unreserve(sa_manager->bo);
<------><------>dev_err(rdev->dev, "(%d) failed to pin manager bo\n", r);
<------><------>return r;
<------>}
<------>r = radeon_bo_kmap(sa_manager->bo, &sa_manager->cpu_ptr);
<------>radeon_bo_unreserve(sa_manager->bo);
<------>return r;
}
 
int radeon_sa_bo_manager_suspend(struct radeon_device *rdev,
<------><------><------><------> struct radeon_sa_manager *sa_manager)
{
<------>int r;
 
<------>if (sa_manager->bo == NULL) {
<------><------>dev_err(rdev->dev, "no bo for sa manager\n");
<------><------>return -EINVAL;
<------>}
 
<------>r = radeon_bo_reserve(sa_manager->bo, false);
<------>if (!r) {
<------><------>radeon_bo_kunmap(sa_manager->bo);
<------><------>radeon_bo_unpin(sa_manager->bo);
<------><------>radeon_bo_unreserve(sa_manager->bo);
<------>}
<------>return r;
}
 
static void radeon_sa_bo_remove_locked(struct radeon_sa_bo *sa_bo)
{
<------>struct radeon_sa_manager *sa_manager = sa_bo->manager;
<------>if (sa_manager->hole == &sa_bo->olist) {
<------><------>sa_manager->hole = sa_bo->olist.prev;
<------>}
<------>list_del_init(&sa_bo->olist);
<------>list_del_init(&sa_bo->flist);
<------>radeon_fence_unref(&sa_bo->fence);
<------>kfree(sa_bo);
}
 
static void radeon_sa_bo_try_free(struct radeon_sa_manager *sa_manager)
{
<------>struct radeon_sa_bo *sa_bo, *tmp;
 
<------>if (sa_manager->hole->next == &sa_manager->olist)
<------><------>return;
 
<------>sa_bo = list_entry(sa_manager->hole->next, struct radeon_sa_bo, olist);
<------>list_for_each_entry_safe_from(sa_bo, tmp, &sa_manager->olist, olist) {
<------><------>if (sa_bo->fence == NULL || !radeon_fence_signaled(sa_bo->fence)) {
<------><------><------>return;
<------><------>}
<------><------>radeon_sa_bo_remove_locked(sa_bo);
<------>}
}
 
static inline unsigned radeon_sa_bo_hole_soffset(struct radeon_sa_manager *sa_manager)
{
<------>struct list_head *hole = sa_manager->hole;
 
<------>if (hole != &sa_manager->olist) {
<------><------>return list_entry(hole, struct radeon_sa_bo, olist)->eoffset;
<------>}
<------>return 0;
}
 
static inline unsigned radeon_sa_bo_hole_eoffset(struct radeon_sa_manager *sa_manager)
{
<------>struct list_head *hole = sa_manager->hole;
 
<------>if (hole->next != &sa_manager->olist) {
<------><------>return list_entry(hole->next, struct radeon_sa_bo, olist)->soffset;
<------>}
<------>return sa_manager->size;
}
 
static bool radeon_sa_bo_try_alloc(struct radeon_sa_manager *sa_manager,
<------><------><------><------>   struct radeon_sa_bo *sa_bo,
<------><------><------><------>   unsigned size, unsigned align)
{
<------>unsigned soffset, eoffset, wasted;
 
<------>soffset = radeon_sa_bo_hole_soffset(sa_manager);
<------>eoffset = radeon_sa_bo_hole_eoffset(sa_manager);
<------>wasted = (align - (soffset % align)) % align;
 
<------>if ((eoffset - soffset) >= (size + wasted)) {
<------><------>soffset += wasted;
 
<------><------>sa_bo->manager = sa_manager;
<------><------>sa_bo->soffset = soffset;
<------><------>sa_bo->eoffset = soffset + size;
<------><------>list_add(&sa_bo->olist, sa_manager->hole);
<------><------>INIT_LIST_HEAD(&sa_bo->flist);
<------><------>sa_manager->hole = &sa_bo->olist;
<------><------>return true;
<------>}
<------>return false;
}
 
/**
 * radeon_sa_event - Check if we can stop waiting
 *
 * @sa_manager: pointer to the sa_manager
 * @size: number of bytes we want to allocate
 * @align: alignment we need to match
 *
 * Check if either there is a fence we can wait for or
 * enough free memory to satisfy the allocation directly
 */
static bool radeon_sa_event(struct radeon_sa_manager *sa_manager,
<------><------><------>    unsigned size, unsigned align)
{
<------>unsigned soffset, eoffset, wasted;
<------>int i;
 
<------>for (i = 0; i < RADEON_NUM_RINGS; ++i) {
<------><------>if (!list_empty(&sa_manager->flist[i])) {
<------><------><------>return true;
<------><------>}
<------>}
 
<------>soffset = radeon_sa_bo_hole_soffset(sa_manager);
<------>eoffset = radeon_sa_bo_hole_eoffset(sa_manager);
<------>wasted = (align - (soffset % align)) % align;
 
<------>if ((eoffset - soffset) >= (size + wasted)) {
<------><------>return true;
<------>}
 
<------>return false;
}
 
static bool radeon_sa_bo_next_hole(struct radeon_sa_manager *sa_manager,
<------><------><------><------>   struct radeon_fence **fences,
<------><------><------><------>   unsigned *tries)
{
<------>struct radeon_sa_bo *best_bo = NULL;
<------>unsigned i, soffset, best, tmp;
 
<------>/* if hole points to the end of the buffer */
<------>if (sa_manager->hole->next == &sa_manager->olist) {
<------><------>/* try again with its beginning */
<------><------>sa_manager->hole = &sa_manager->olist;
<------><------>return true;
<------>}
 
<------>soffset = radeon_sa_bo_hole_soffset(sa_manager);
<------>/* to handle wrap around we add sa_manager->size */
<------>best = sa_manager->size * 2;
<------>/* go over all fence list and try to find the closest sa_bo
<------> * of the current last
<------> */
<------>for (i = 0; i < RADEON_NUM_RINGS; ++i) {
<------><------>struct radeon_sa_bo *sa_bo;
 
<------><------>if (list_empty(&sa_manager->flist[i])) {
<------><------><------>continue;
<------><------>}
 
<------><------>sa_bo = list_first_entry(&sa_manager->flist[i],
<------><------><------><------><------> struct radeon_sa_bo, flist);
 
<------><------>if (!radeon_fence_signaled(sa_bo->fence)) {
<------><------><------>fences[i] = sa_bo->fence;
<------><------><------>continue;
<------><------>}
 
<------><------>/* limit the number of tries each ring gets */
<------><------>if (tries[i] > 2) {
<------><------><------>continue;
<------><------>}
 
<------><------>tmp = sa_bo->soffset;
<------><------>if (tmp < soffset) {
<------><------><------>/* wrap around, pretend it's after */
<------><------><------>tmp += sa_manager->size;
<------><------>}
<------><------>tmp -= soffset;
<------><------>if (tmp < best) {
<------><------><------>/* this sa bo is the closest one */
<------><------><------>best = tmp;
<------><------><------>best_bo = sa_bo;
<------><------>}
<------>}
 
<------>if (best_bo) {
<------><------>++tries[best_bo->fence->ring];
<------><------>sa_manager->hole = best_bo->olist.prev;
 
<------><------>/* we knew that this one is signaled,
<------><------>   so it's save to remote it */
<------><------>radeon_sa_bo_remove_locked(best_bo);
<------><------>return true;
<------>}
<------>return false;
}
 
int radeon_sa_bo_new(struct radeon_device *rdev,
<------><------>     struct radeon_sa_manager *sa_manager,
<------><------>     struct radeon_sa_bo **sa_bo,
<------><------>     unsigned size, unsigned align)
{
<------>struct radeon_fence *fences[RADEON_NUM_RINGS];
<------>unsigned tries[RADEON_NUM_RINGS];
<------>int i, r;
 
<------>BUG_ON(align > sa_manager->align);
<------>BUG_ON(size > sa_manager->size);
 
<------>*sa_bo = kmalloc(sizeof(struct radeon_sa_bo), GFP_KERNEL);
<------>if ((*sa_bo) == NULL) {
<------><------>return -ENOMEM;
<------>}
<------>(*sa_bo)->manager = sa_manager;
<------>(*sa_bo)->fence = NULL;
<------>INIT_LIST_HEAD(&(*sa_bo)->olist);
<------>INIT_LIST_HEAD(&(*sa_bo)->flist);
 
<------>spin_lock(&sa_manager->wq.lock);
<------>do {
<------><------>for (i = 0; i < RADEON_NUM_RINGS; ++i) {
<------><------><------>fences[i] = NULL;
<------><------><------>tries[i] = 0;
<------><------>}
 
<------><------>do {
<------><------><------>radeon_sa_bo_try_free(sa_manager);
 
<------><------><------>if (radeon_sa_bo_try_alloc(sa_manager, *sa_bo,
<------><------><------><------><------><------>   size, align)) {
<------><------><------><------>spin_unlock(&sa_manager->wq.lock);
<------><------><------><------>return 0;
<------><------><------>}
 
<------><------><------>/* see if we can skip over some allocations */
<------><------>} while (radeon_sa_bo_next_hole(sa_manager, fences, tries));
 
<------><------>for (i = 0; i < RADEON_NUM_RINGS; ++i)
<------><------><------>radeon_fence_ref(fences[i]);
 
<------><------>spin_unlock(&sa_manager->wq.lock);
<------><------>r = radeon_fence_wait_any(rdev, fences, false);
<------><------>for (i = 0; i < RADEON_NUM_RINGS; ++i)
<------><------><------>radeon_fence_unref(&fences[i]);
<------><------>spin_lock(&sa_manager->wq.lock);
<------><------>/* if we have nothing to wait for block */
<------><------>if (r == -ENOENT) {
<------><------><------>r = wait_event_interruptible_locked(
<------><------><------><------>sa_manager->wq, 
<------><------><------><------>radeon_sa_event(sa_manager, size, align)
<------><------><------>);
<------><------>}
 
<------>} while (!r);
 
<------>spin_unlock(&sa_manager->wq.lock);
<------>kfree(*sa_bo);
<------>*sa_bo = NULL;
<------>return r;
}
 
void radeon_sa_bo_free(struct radeon_device *rdev, struct radeon_sa_bo **sa_bo,
<------><------>       struct radeon_fence *fence)
{
<------>struct radeon_sa_manager *sa_manager;
 
<------>if (sa_bo == NULL || *sa_bo == NULL) {
<------><------>return;
<------>}
 
<------>sa_manager = (*sa_bo)->manager;
<------>spin_lock(&sa_manager->wq.lock);
<------>if (fence && !radeon_fence_signaled(fence)) {
<------><------>(*sa_bo)->fence = radeon_fence_ref(fence);
<------><------>list_add_tail(&(*sa_bo)->flist,
<------><------><------>      &sa_manager->flist[fence->ring]);
<------>} else {
<------><------>radeon_sa_bo_remove_locked(*sa_bo);
<------>}
<------>wake_up_all_locked(&sa_manager->wq);
<------>spin_unlock(&sa_manager->wq.lock);
<------>*sa_bo = NULL;
}
 
#if defined(CONFIG_DEBUG_FS)
void radeon_sa_bo_dump_debug_info(struct radeon_sa_manager *sa_manager,
<------><------><------><------>  struct seq_file *m)
{
<------>struct radeon_sa_bo *i;
 
<------>spin_lock(&sa_manager->wq.lock);
<------>list_for_each_entry(i, &sa_manager->olist, olist) {
<------><------>uint64_t soffset = i->soffset + sa_manager->gpu_addr;
<------><------>uint64_t eoffset = i->eoffset + sa_manager->gpu_addr;
<------><------>if (&i->olist == sa_manager->hole) {
<------><------><------>seq_printf(m, ">");
<------><------>} else {
<------><------><------>seq_printf(m, " ");
<------><------>}
<------><------>seq_printf(m, "[0x%010llx 0x%010llx] size %8lld",
<------><------><------>   soffset, eoffset, eoffset - soffset);
<------><------>if (i->fence) {
<------><------><------>seq_printf(m, " protected by 0x%016llx on ring %d",
<------><------><------><------>   i->fence->seq, i->fence->ring);
<------><------>}
<------><------>seq_printf(m, "\n");
<------>}
<------>spin_unlock(&sa_manager->wq.lock);
}
#endif