| /************************************************************************** |
| * |
| * Copyright © 2009-2015 VMware, Inc., Palo Alto, CA., USA |
| * 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 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 <drm/drmP.h> |
| #include "vmwgfx_drv.h" |
| |
| #define VMW_FENCE_WRAP (1 << 24) |
| |
| 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; |
| |
| spin_lock(&dev_priv->irq_lock); |
| status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| masked_status = status & dev_priv->irq_mask; |
| spin_unlock(&dev_priv->irq_lock); |
| |
| if (likely(status)) |
| outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| |
| if (!masked_status) |
| return IRQ_NONE; |
| |
| if (masked_status & (SVGA_IRQFLAG_ANY_FENCE | |
| SVGA_IRQFLAG_FENCE_GOAL)) { |
| vmw_fences_update(dev_priv->fman); |
| wake_up_all(&dev_priv->fence_queue); |
| } |
| |
| if (masked_status & SVGA_IRQFLAG_FIFO_PROGRESS) |
| wake_up_all(&dev_priv->fifo_queue); |
| |
| if (masked_status & (SVGA_IRQFLAG_COMMAND_BUFFER | |
| SVGA_IRQFLAG_ERROR)) |
| vmw_cmdbuf_tasklet_schedule(dev_priv->cman); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static bool vmw_fifo_idle(struct vmw_private *dev_priv, uint32_t seqno) |
| { |
| |
| return (vmw_read(dev_priv, SVGA_REG_BUSY) == 0); |
| } |
| |
| void vmw_update_seqno(struct vmw_private *dev_priv, |
| struct vmw_fifo_state *fifo_state) |
| { |
| u32 __iomem *fifo_mem = dev_priv->mmio_virt; |
| uint32_t seqno = ioread32(fifo_mem + SVGA_FIFO_FENCE); |
| |
| if (dev_priv->last_read_seqno != seqno) { |
| dev_priv->last_read_seqno = seqno; |
| vmw_marker_pull(&fifo_state->marker_queue, seqno); |
| vmw_fences_update(dev_priv->fman); |
| } |
| } |
| |
| bool vmw_seqno_passed(struct vmw_private *dev_priv, |
| uint32_t seqno) |
| { |
| struct vmw_fifo_state *fifo_state; |
| bool ret; |
| |
| if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP)) |
| return true; |
| |
| fifo_state = &dev_priv->fifo; |
| vmw_update_seqno(dev_priv, fifo_state); |
| if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP)) |
| return true; |
| |
| if (!(fifo_state->capabilities & SVGA_FIFO_CAP_FENCE) && |
| 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; |
| |
| 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) { |
| down_read(&fifo_state->rwsem); |
| if (dev_priv->cman) { |
| ret = vmw_cmdbuf_idle(dev_priv->cman, interruptible, |
| 10*HZ); |
| if (ret) |
| goto out_err; |
| } |
| } |
| |
| 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) { |
| u32 __iomem *fifo_mem = dev_priv->mmio_virt; |
| iowrite32(signal_seq, fifo_mem + SVGA_FIFO_FENCE); |
| } |
| wake_up_all(&dev_priv->fence_queue); |
| out_err: |
| if (fifo_idle) |
| up_read(&fifo_state->rwsem); |
| |
| return ret; |
| } |
| |
| void vmw_seqno_waiter_add(struct vmw_private *dev_priv) |
| { |
| spin_lock(&dev_priv->waiter_lock); |
| if (dev_priv->fence_queue_waiters++ == 0) { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| outl(SVGA_IRQFLAG_ANY_FENCE, |
| dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| dev_priv->irq_mask |= SVGA_IRQFLAG_ANY_FENCE; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |
| spin_unlock(&dev_priv->waiter_lock); |
| } |
| |
| void vmw_seqno_waiter_remove(struct vmw_private *dev_priv) |
| { |
| spin_lock(&dev_priv->waiter_lock); |
| if (--dev_priv->fence_queue_waiters == 0) { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| dev_priv->irq_mask &= ~SVGA_IRQFLAG_ANY_FENCE; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |
| spin_unlock(&dev_priv->waiter_lock); |
| } |
| |
| |
| void vmw_goal_waiter_add(struct vmw_private *dev_priv) |
| { |
| spin_lock(&dev_priv->waiter_lock); |
| if (dev_priv->goal_queue_waiters++ == 0) { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| outl(SVGA_IRQFLAG_FENCE_GOAL, |
| dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| dev_priv->irq_mask |= SVGA_IRQFLAG_FENCE_GOAL; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |
| spin_unlock(&dev_priv->waiter_lock); |
| } |
| |
| void vmw_goal_waiter_remove(struct vmw_private *dev_priv) |
| { |
| spin_lock(&dev_priv->waiter_lock); |
| if (--dev_priv->goal_queue_waiters == 0) { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| dev_priv->irq_mask &= ~SVGA_IRQFLAG_FENCE_GOAL; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |
| spin_unlock(&dev_priv->waiter_lock); |
| } |
| |
| int vmw_wait_seqno(struct vmw_private *dev_priv, |
| bool lazy, uint32_t seqno, |
| bool interruptible, unsigned long timeout) |
| { |
| long ret; |
| struct vmw_fifo_state *fifo = &dev_priv->fifo; |
| |
| if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP)) |
| return 0; |
| |
| if (likely(vmw_seqno_passed(dev_priv, seqno))) |
| return 0; |
| |
| vmw_fifo_ping_host(dev_priv, SVGA_SYNC_GENERIC); |
| |
| if (!(fifo->capabilities & SVGA_FIFO_CAP_FENCE)) |
| return vmw_fallback_wait(dev_priv, lazy, true, seqno, |
| interruptible, timeout); |
| |
| if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK)) |
| return vmw_fallback_wait(dev_priv, lazy, false, seqno, |
| interruptible, timeout); |
| |
| vmw_seqno_waiter_add(dev_priv); |
| |
| if (interruptible) |
| ret = wait_event_interruptible_timeout |
| (dev_priv->fence_queue, |
| vmw_seqno_passed(dev_priv, seqno), |
| timeout); |
| else |
| ret = wait_event_timeout |
| (dev_priv->fence_queue, |
| vmw_seqno_passed(dev_priv, seqno), |
| timeout); |
| |
| vmw_seqno_waiter_remove(dev_priv); |
| |
| if (unlikely(ret == 0)) |
| ret = -EBUSY; |
| else if (likely(ret > 0)) |
| ret = 0; |
| |
| return ret; |
| } |
| |
| void vmw_irq_preinstall(struct drm_device *dev) |
| { |
| struct vmw_private *dev_priv = vmw_priv(dev); |
| uint32_t status; |
| |
| if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK)) |
| return; |
| |
| spin_lock_init(&dev_priv->irq_lock); |
| status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| } |
| |
| int vmw_irq_postinstall(struct drm_device *dev) |
| { |
| return 0; |
| } |
| |
| void vmw_irq_uninstall(struct drm_device *dev) |
| { |
| struct vmw_private *dev_priv = vmw_priv(dev); |
| uint32_t status; |
| |
| if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK)) |
| return; |
| |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, 0); |
| |
| status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| } |
| |
| void vmw_generic_waiter_add(struct vmw_private *dev_priv, |
| u32 flag, int *waiter_count) |
| { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| if ((*waiter_count)++ == 0) { |
| outl(flag, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT); |
| dev_priv->irq_mask |= flag; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| } |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |
| |
| void vmw_generic_waiter_remove(struct vmw_private *dev_priv, |
| u32 flag, int *waiter_count) |
| { |
| unsigned long irq_flags; |
| |
| spin_lock_irqsave(&dev_priv->irq_lock, irq_flags); |
| if (--(*waiter_count) == 0) { |
| dev_priv->irq_mask &= ~flag; |
| vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask); |
| } |
| spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags); |
| } |