Quelle  vmwgfx_irq.c   Sprache: 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;
}