mirror of
https://github.com/KolibriOS/kolibrios.git
synced 2024-12-14 19:07:09 +03:00
327 lines
8.8 KiB
C
327 lines
8.8 KiB
C
|
/**************************************************************************
|
||
|
*
|
||
|
* Copyright © 2009 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 TASK_INTERRUPTIBLE 1
|
||
|
#define TASK_UNINTERRUPTIBLE 2
|
||
|
|
||
|
#define VMW_FENCE_WRAP (1 << 24)
|
||
|
|
||
|
irqreturn_t vmw_irq_handler(DRM_IRQ_ARGS)
|
||
|
{
|
||
|
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);
|
||
|
|
||
|
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
static bool vmw_fifo_idle(struct vmw_private *dev_priv, uint32_t seqno)
|
||
|
{
|
||
|
uint32_t busy;
|
||
|
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
busy = vmw_read(dev_priv, SVGA_REG_BUSY);
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
|
||
|
return (busy == 0);
|
||
|
}
|
||
|
|
||
|
void vmw_update_seqno(struct vmw_private *dev_priv,
|
||
|
struct vmw_fifo_state *fifo_state)
|
||
|
{
|
||
|
__le32 __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 = GetTimerTicks() + 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);
|
||
|
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(GetTimerTicks(), end_jiffies)) {
|
||
|
DRM_ERROR("SVGA device lockup.\n");
|
||
|
break;
|
||
|
}
|
||
|
if (lazy)
|
||
|
delay(1);
|
||
|
else if ((++count & 0x0F) == 0) {
|
||
|
/**
|
||
|
* FIXME: Use schedule_hr_timeout here for
|
||
|
* newer kernels and lower CPU utilization.
|
||
|
*/
|
||
|
|
||
|
delay(1);
|
||
|
}
|
||
|
}
|
||
|
// finish_wait(&dev_priv->fence_queue, &__wait);
|
||
|
if (ret == 0 && fifo_idle) {
|
||
|
__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
|
||
|
iowrite32(signal_seq, fifo_mem + SVGA_FIFO_FENCE);
|
||
|
}
|
||
|
wake_up_all(&dev_priv->fence_queue);
|
||
|
// if (fifo_idle)
|
||
|
// up_read(&fifo_state->rwsem);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
void vmw_seqno_waiter_add(struct vmw_private *dev_priv)
|
||
|
{
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
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);
|
||
|
}
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
}
|
||
|
|
||
|
void vmw_seqno_waiter_remove(struct vmw_private *dev_priv)
|
||
|
{
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
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);
|
||
|
}
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
}
|
||
|
|
||
|
|
||
|
void vmw_goal_waiter_add(struct vmw_private *dev_priv)
|
||
|
{
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
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);
|
||
|
}
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
}
|
||
|
|
||
|
void vmw_goal_waiter_remove(struct vmw_private *dev_priv)
|
||
|
{
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
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);
|
||
|
}
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
}
|
||
|
|
||
|
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;
|
||
|
|
||
|
mutex_lock(&dev_priv->hw_mutex);
|
||
|
vmw_write(dev_priv, SVGA_REG_IRQMASK, 0);
|
||
|
mutex_unlock(&dev_priv->hw_mutex);
|
||
|
|
||
|
status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
|
||
|
outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
|
||
|
}
|
||
|
|
||
|
int autoremove_wake_function(wait_queue_t *wait, unsigned mode, int sync, void *key)
|
||
|
{
|
||
|
list_del_init(&wait->task_list);
|
||
|
return 1;
|
||
|
}
|
||
|
|