root/drivers/gpu/drm/vmwgfx/vmwgfx_irq.c
// SPDX-License-Identifier: GPL-2.0 OR MIT
/**************************************************************************
 *
 * Copyright 2009-2015 VMware, Inc., Palo Alto, CA., USA
 *
 * 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 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 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.
 *
 **************************************************************************/

#include <linux/pci.h>
#include <linux/sched/signal.h>

#include "vmwgfx_drv.h"

#define VMW_FENCE_WRAP (1 << 24)

static u32 vmw_irqflag_fence_goal(struct vmw_private *vmw)
{
        if ((vmw->capabilities2 & SVGA_CAP2_EXTRA_REGS) != 0)
                return SVGA_IRQFLAG_REG_FENCE_GOAL;
        else
                return SVGA_IRQFLAG_FENCE_GOAL;
}

/**
 * vmw_thread_fn - Deferred (process context) irq handler
 *
 * @irq: irq number
 * @arg: Closure argument. Pointer to a struct drm_device cast to void *
 *
 * This function implements the deferred part of irq processing.
 * The function is guaranteed to run at least once after the
 * vmw_irq_handler has returned with IRQ_WAKE_THREAD.
 *
 */
static irqreturn_t vmw_thread_fn(int irq, void *arg)
{
        struct drm_device *dev = (struct drm_device *)arg;
        struct vmw_private *dev_priv = vmw_priv(dev);
        irqreturn_t ret = IRQ_NONE;

        if (test_and_clear_bit(VMW_IRQTHREAD_FENCE,
                               dev_priv->irqthread_pending)) {
                vmw_fences_update(dev_priv->fman);
                wake_up_all(&dev_priv->fence_queue);
                ret = IRQ_HANDLED;
        }

        if (test_and_clear_bit(VMW_IRQTHREAD_CMDBUF,
                               dev_priv->irqthread_pending)) {
                vmw_cmdbuf_irqthread(dev_priv->cman);
                ret = IRQ_HANDLED;
        }

        return ret;
}

/**
 * vmw_irq_handler: irq handler
 *
 * @irq: irq number
 * @arg: Closure argument. Pointer to a struct drm_device cast to void *
 *
 * This function implements the quick part of irq processing.
 * The function performs fast actions like clearing the device interrupt
 * flags and also reasonably quick actions like waking processes waiting for
 * FIFO space. Other IRQ actions are deferred to the IRQ thread.
 */
static irqreturn_t vmw_irq_handler(int irq, void *arg)
{
        struct drm_device *dev = (struct drm_device *)arg;
        struct vmw_private *dev_priv = vmw_priv(dev);
        uint32_t status, masked_status;
        irqreturn_t ret = IRQ_HANDLED;

        status = vmw_irq_status_read(dev_priv);
        masked_status = status & READ_ONCE(dev_priv->irq_mask);

        if (likely(status))
                vmw_irq_status_write(dev_priv, status);

        if (!status)
                return IRQ_NONE;

        if (masked_status & SVGA_IRQFLAG_FIFO_PROGRESS)
                wake_up_all(&dev_priv->fifo_queue);

        if ((masked_status & (SVGA_IRQFLAG_ANY_FENCE |
                              vmw_irqflag_fence_goal(dev_priv))) &&
            !test_and_set_bit(VMW_IRQTHREAD_FENCE, dev_priv->irqthread_pending))
                ret = IRQ_WAKE_THREAD;

        if ((masked_status & (SVGA_IRQFLAG_COMMAND_BUFFER |
                              SVGA_IRQFLAG_ERROR)) &&
            !test_and_set_bit(VMW_IRQTHREAD_CMDBUF,
                              dev_priv->irqthread_pending))
                ret = IRQ_WAKE_THREAD;

        return ret;
}

static bool vmw_fifo_idle(struct vmw_private *dev_priv, uint32_t seqno)
{

        return (vmw_read(dev_priv, SVGA_REG_BUSY) == 0);
}

bool vmw_seqno_passed(struct vmw_private *dev_priv,
                         uint32_t seqno)
{
        bool ret;
        u32 last_read_seqno = atomic_read_acquire(&dev_priv->last_read_seqno);

        if (last_read_seqno - seqno < VMW_FENCE_WRAP)
                return true;

        last_read_seqno = vmw_fences_update(dev_priv->fman);
        if (last_read_seqno - seqno < VMW_FENCE_WRAP)
                return true;

        if (!vmw_has_fences(dev_priv) && vmw_fifo_idle(dev_priv, seqno))
                return true;

        /**
         * Then check if the seqno is higher than what we've actually
         * emitted. Then the fence is stale and signaled.
         */

        ret = ((atomic_read(&dev_priv->marker_seq) - seqno)
               > VMW_FENCE_WRAP);

        return ret;
}

int vmw_fallback_wait(struct vmw_private *dev_priv,
                      bool lazy,
                      bool fifo_idle,
                      uint32_t seqno,
                      bool interruptible,
                      unsigned long timeout)
{
        struct vmw_fifo_state *fifo_state = dev_priv->fifo;
        bool fifo_down = false;

        uint32_t count = 0;
        uint32_t signal_seq;
        int ret;
        unsigned long end_jiffies = jiffies + timeout;
        bool (*wait_condition)(struct vmw_private *, uint32_t);
        DEFINE_WAIT(__wait);

        wait_condition = (fifo_idle) ? &vmw_fifo_idle :
                &vmw_seqno_passed;

        /**
         * Block command submission while waiting for idle.
         */

        if (fifo_idle) {
                if (dev_priv->cman) {
                        ret = vmw_cmdbuf_idle(dev_priv->cman, interruptible,
                                              10*HZ);
                        if (ret)
                                goto out_err;
                } else if (fifo_state) {
                        down_read(&fifo_state->rwsem);
                        fifo_down = true;
                }
        }

        signal_seq = atomic_read(&dev_priv->marker_seq);
        ret = 0;

        for (;;) {
                prepare_to_wait(&dev_priv->fence_queue, &__wait,
                                (interruptible) ?
                                TASK_INTERRUPTIBLE : TASK_UNINTERRUPTIBLE);
                if (wait_condition(dev_priv, seqno))
                        break;
                if (time_after_eq(jiffies, end_jiffies)) {
                        DRM_ERROR("SVGA device lockup.\n");
                        break;
                }
                if (lazy)
                        schedule_timeout(1);
                else if ((++count & 0x0F) == 0) {
                        /**
                         * FIXME: Use schedule_hr_timeout here for
                         * newer kernels and lower CPU utilization.
                         */

                        __set_current_state(TASK_RUNNING);
                        schedule();
                        __set_current_state((interruptible) ?
                                            TASK_INTERRUPTIBLE :
                                            TASK_UNINTERRUPTIBLE);
                }
                if (interruptible && signal_pending(current)) {
                        ret = -ERESTARTSYS;
                        break;
                }
        }
        finish_wait(&dev_priv->fence_queue, &__wait);
        if (ret == 0 && fifo_idle && fifo_state)
                vmw_fence_write(dev_priv, signal_seq);

        wake_up_all(&dev_priv->fence_queue);
out_err:
        if (fifo_down)
                up_read(&fifo_state->rwsem);

        return ret;
}

bool vmw_generic_waiter_add(struct vmw_private *dev_priv,
                            u32 flag, int *waiter_count)
{
        bool hw_programmed = false;

        spin_lock(&dev_priv->waiter_lock);
        if ((*waiter_count)++ == 0) {
                vmw_irq_status_write(dev_priv, flag);
                dev_priv->irq_mask |= flag;
                vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
                hw_programmed = true;
        }
        spin_unlock(&dev_priv->waiter_lock);
        return hw_programmed;
}

bool vmw_generic_waiter_remove(struct vmw_private *dev_priv,
                               u32 flag, int *waiter_count)
{
        bool hw_programmed = false;

        spin_lock(&dev_priv->waiter_lock);
        if (--(*waiter_count) == 0) {
                dev_priv->irq_mask &= ~flag;
                vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
                hw_programmed = true;
        }
        spin_unlock(&dev_priv->waiter_lock);
        return hw_programmed;
}

bool vmw_seqno_waiter_add(struct vmw_private *dev_priv)
{
        return vmw_generic_waiter_add(dev_priv, SVGA_IRQFLAG_ANY_FENCE,
                                        &dev_priv->fence_queue_waiters);
}

bool vmw_seqno_waiter_remove(struct vmw_private *dev_priv)
{
        return vmw_generic_waiter_remove(dev_priv, SVGA_IRQFLAG_ANY_FENCE,
                                        &dev_priv->fence_queue_waiters);
}

bool vmw_goal_waiter_add(struct vmw_private *dev_priv)
{
        return vmw_generic_waiter_add(dev_priv, vmw_irqflag_fence_goal(dev_priv),
                                        &dev_priv->goal_queue_waiters);
}

bool vmw_goal_waiter_remove(struct vmw_private *dev_priv)
{
        return vmw_generic_waiter_remove(dev_priv, vmw_irqflag_fence_goal(dev_priv),
                                        &dev_priv->goal_queue_waiters);
}

static void vmw_irq_preinstall(struct drm_device *dev)
{
        struct vmw_private *dev_priv = vmw_priv(dev);
        uint32_t status;

        status = vmw_irq_status_read(dev_priv);
        vmw_irq_status_write(dev_priv, status);
}

void vmw_irq_uninstall(struct drm_device *dev)
{
        struct vmw_private *dev_priv = vmw_priv(dev);
        struct pci_dev *pdev = to_pci_dev(dev->dev);
        uint32_t status;
        u32 i;

        if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
                return;

        vmw_write(dev_priv, SVGA_REG_IRQMASK, 0);

        status = vmw_irq_status_read(dev_priv);
        vmw_irq_status_write(dev_priv, status);

        for (i = 0; i < dev_priv->num_irq_vectors; ++i)
                free_irq(dev_priv->irqs[i], dev);

        pci_free_irq_vectors(pdev);
        dev_priv->num_irq_vectors = 0;
}

/**
 * vmw_irq_install - Install the irq handlers
 *
 * @dev_priv:  Pointer to the vmw_private device.
 * Return:  Zero if successful. Negative number otherwise.
 */
int vmw_irq_install(struct vmw_private *dev_priv)
{
        struct pci_dev *pdev = to_pci_dev(dev_priv->drm.dev);
        struct drm_device *dev = &dev_priv->drm;
        int ret;
        int nvec;
        int i = 0;

        BUILD_BUG_ON((SVGA_IRQFLAG_MAX >> VMWGFX_MAX_NUM_IRQS) != 1);
        BUG_ON(VMWGFX_MAX_NUM_IRQS != get_count_order(SVGA_IRQFLAG_MAX));

        nvec = pci_alloc_irq_vectors(pdev, 1, VMWGFX_MAX_NUM_IRQS,
                                     PCI_IRQ_ALL_TYPES);

        if (nvec <= 0) {
                drm_err(&dev_priv->drm,
                        "IRQ's are unavailable, nvec: %d\n", nvec);
                ret = nvec;
                goto done;
        }

        vmw_irq_preinstall(dev);

        for (i = 0; i < nvec; ++i) {
                ret = pci_irq_vector(pdev, i);
                if (ret < 0) {
                        drm_err(&dev_priv->drm,
                                "failed getting irq vector: %d\n", ret);
                        goto done;
                }
                dev_priv->irqs[i] = ret;

                ret = request_threaded_irq(dev_priv->irqs[i], vmw_irq_handler, vmw_thread_fn,
                                           IRQF_SHARED, VMWGFX_DRIVER_NAME, dev);
                if (ret != 0) {
                        drm_err(&dev_priv->drm,
                                "Failed installing irq(%d): %d\n",
                                dev_priv->irqs[i], ret);
                        goto done;
                }
        }

done:
        dev_priv->num_irq_vectors = i;
        return ret;
}