1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include <drm/drmP.h>
29#include "vmwgfx_drv.h"
30
31#define VMW_FENCE_WRAP (1 << 24)
32
33irqreturn_t vmw_irq_handler(int irq, void *arg)
34{
35 struct drm_device *dev = (struct drm_device *)arg;
36 struct vmw_private *dev_priv = vmw_priv(dev);
37 uint32_t status, masked_status;
38
39 spin_lock(&dev_priv->irq_lock);
40 status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
41 masked_status = status & dev_priv->irq_mask;
42 spin_unlock(&dev_priv->irq_lock);
43
44 if (likely(status))
45 outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
46
47 if (!masked_status)
48 return IRQ_NONE;
49
50 if (masked_status & (SVGA_IRQFLAG_ANY_FENCE |
51 SVGA_IRQFLAG_FENCE_GOAL)) {
52 vmw_fences_update(dev_priv->fman);
53 wake_up_all(&dev_priv->fence_queue);
54 }
55
56 if (masked_status & SVGA_IRQFLAG_FIFO_PROGRESS)
57 wake_up_all(&dev_priv->fifo_queue);
58
59
60 return IRQ_HANDLED;
61}
62
63static bool vmw_fifo_idle(struct vmw_private *dev_priv, uint32_t seqno)
64{
65
66 return (vmw_read(dev_priv, SVGA_REG_BUSY) == 0);
67}
68
69void vmw_update_seqno(struct vmw_private *dev_priv,
70 struct vmw_fifo_state *fifo_state)
71{
72 __le32 __iomem *fifo_mem = dev_priv->mmio_virt;
73 uint32_t seqno = ioread32(fifo_mem + SVGA_FIFO_FENCE);
74
75 if (dev_priv->last_read_seqno != seqno) {
76 dev_priv->last_read_seqno = seqno;
77 vmw_marker_pull(&fifo_state->marker_queue, seqno);
78 vmw_fences_update(dev_priv->fman);
79 }
80}
81
82bool vmw_seqno_passed(struct vmw_private *dev_priv,
83 uint32_t seqno)
84{
85 struct vmw_fifo_state *fifo_state;
86 bool ret;
87
88 if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP))
89 return true;
90
91 fifo_state = &dev_priv->fifo;
92 vmw_update_seqno(dev_priv, fifo_state);
93 if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP))
94 return true;
95
96 if (!(fifo_state->capabilities & SVGA_FIFO_CAP_FENCE) &&
97 vmw_fifo_idle(dev_priv, seqno))
98 return true;
99
100
101
102
103
104
105 ret = ((atomic_read(&dev_priv->marker_seq) - seqno)
106 > VMW_FENCE_WRAP);
107
108 return ret;
109}
110
111int vmw_fallback_wait(struct vmw_private *dev_priv,
112 bool lazy,
113 bool fifo_idle,
114 uint32_t seqno,
115 bool interruptible,
116 unsigned long timeout)
117{
118 struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
119
120 uint32_t count = 0;
121 uint32_t signal_seq;
122 int ret;
123 unsigned long end_jiffies = jiffies + timeout;
124 bool (*wait_condition)(struct vmw_private *, uint32_t);
125 DEFINE_WAIT(__wait);
126
127 wait_condition = (fifo_idle) ? &vmw_fifo_idle :
128 &vmw_seqno_passed;
129
130
131
132
133
134 if (fifo_idle)
135 down_read(&fifo_state->rwsem);
136 signal_seq = atomic_read(&dev_priv->marker_seq);
137 ret = 0;
138
139 for (;;) {
140 prepare_to_wait(&dev_priv->fence_queue, &__wait,
141 (interruptible) ?
142 TASK_INTERRUPTIBLE : TASK_UNINTERRUPTIBLE);
143 if (wait_condition(dev_priv, seqno))
144 break;
145 if (time_after_eq(jiffies, end_jiffies)) {
146 DRM_ERROR("SVGA device lockup.\n");
147 break;
148 }
149 if (lazy)
150 schedule_timeout(1);
151 else if ((++count & 0x0F) == 0) {
152
153
154
155
156
157 __set_current_state(TASK_RUNNING);
158 schedule();
159 __set_current_state((interruptible) ?
160 TASK_INTERRUPTIBLE :
161 TASK_UNINTERRUPTIBLE);
162 }
163 if (interruptible && signal_pending(current)) {
164 ret = -ERESTARTSYS;
165 break;
166 }
167 }
168 finish_wait(&dev_priv->fence_queue, &__wait);
169 if (ret == 0 && fifo_idle) {
170 __le32 __iomem *fifo_mem = dev_priv->mmio_virt;
171 iowrite32(signal_seq, fifo_mem + SVGA_FIFO_FENCE);
172 }
173 wake_up_all(&dev_priv->fence_queue);
174 if (fifo_idle)
175 up_read(&fifo_state->rwsem);
176
177 return ret;
178}
179
180void vmw_seqno_waiter_add(struct vmw_private *dev_priv)
181{
182 spin_lock(&dev_priv->waiter_lock);
183 if (dev_priv->fence_queue_waiters++ == 0) {
184 unsigned long irq_flags;
185
186 spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
187 outl(SVGA_IRQFLAG_ANY_FENCE,
188 dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
189 dev_priv->irq_mask |= SVGA_IRQFLAG_ANY_FENCE;
190 vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
191 spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
192 }
193 spin_unlock(&dev_priv->waiter_lock);
194}
195
196void vmw_seqno_waiter_remove(struct vmw_private *dev_priv)
197{
198 spin_lock(&dev_priv->waiter_lock);
199 if (--dev_priv->fence_queue_waiters == 0) {
200 unsigned long irq_flags;
201
202 spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
203 dev_priv->irq_mask &= ~SVGA_IRQFLAG_ANY_FENCE;
204 vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
205 spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
206 }
207 spin_unlock(&dev_priv->waiter_lock);
208}
209
210
211void vmw_goal_waiter_add(struct vmw_private *dev_priv)
212{
213 spin_lock(&dev_priv->waiter_lock);
214 if (dev_priv->goal_queue_waiters++ == 0) {
215 unsigned long irq_flags;
216
217 spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
218 outl(SVGA_IRQFLAG_FENCE_GOAL,
219 dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
220 dev_priv->irq_mask |= SVGA_IRQFLAG_FENCE_GOAL;
221 vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
222 spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
223 }
224 spin_unlock(&dev_priv->waiter_lock);
225}
226
227void vmw_goal_waiter_remove(struct vmw_private *dev_priv)
228{
229 spin_lock(&dev_priv->waiter_lock);
230 if (--dev_priv->goal_queue_waiters == 0) {
231 unsigned long irq_flags;
232
233 spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
234 dev_priv->irq_mask &= ~SVGA_IRQFLAG_FENCE_GOAL;
235 vmw_write(dev_priv, SVGA_REG_IRQMASK, dev_priv->irq_mask);
236 spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
237 }
238 spin_unlock(&dev_priv->waiter_lock);
239}
240
241int vmw_wait_seqno(struct vmw_private *dev_priv,
242 bool lazy, uint32_t seqno,
243 bool interruptible, unsigned long timeout)
244{
245 long ret;
246 struct vmw_fifo_state *fifo = &dev_priv->fifo;
247
248 if (likely(dev_priv->last_read_seqno - seqno < VMW_FENCE_WRAP))
249 return 0;
250
251 if (likely(vmw_seqno_passed(dev_priv, seqno)))
252 return 0;
253
254 vmw_fifo_ping_host(dev_priv, SVGA_SYNC_GENERIC);
255
256 if (!(fifo->capabilities & SVGA_FIFO_CAP_FENCE))
257 return vmw_fallback_wait(dev_priv, lazy, true, seqno,
258 interruptible, timeout);
259
260 if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
261 return vmw_fallback_wait(dev_priv, lazy, false, seqno,
262 interruptible, timeout);
263
264 vmw_seqno_waiter_add(dev_priv);
265
266 if (interruptible)
267 ret = wait_event_interruptible_timeout
268 (dev_priv->fence_queue,
269 vmw_seqno_passed(dev_priv, seqno),
270 timeout);
271 else
272 ret = wait_event_timeout
273 (dev_priv->fence_queue,
274 vmw_seqno_passed(dev_priv, seqno),
275 timeout);
276
277 vmw_seqno_waiter_remove(dev_priv);
278
279 if (unlikely(ret == 0))
280 ret = -EBUSY;
281 else if (likely(ret > 0))
282 ret = 0;
283
284 return ret;
285}
286
287void vmw_irq_preinstall(struct drm_device *dev)
288{
289 struct vmw_private *dev_priv = vmw_priv(dev);
290 uint32_t status;
291
292 if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
293 return;
294
295 spin_lock_init(&dev_priv->irq_lock);
296 status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
297 outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
298}
299
300int vmw_irq_postinstall(struct drm_device *dev)
301{
302 return 0;
303}
304
305void vmw_irq_uninstall(struct drm_device *dev)
306{
307 struct vmw_private *dev_priv = vmw_priv(dev);
308 uint32_t status;
309
310 if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
311 return;
312
313 vmw_write(dev_priv, SVGA_REG_IRQMASK, 0);
314
315 status = inl(dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
316 outl(status, dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
317}
318