drm/i915: Extract common MMIO lines
[cascardo/linux.git] / drivers / gpu / drm / i915 / intel_uncore.c
1 /*
2  * Copyright © 2013 Intel Corporation
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice (including the next
12  * paragraph) shall be included in all copies or substantial portions of the
13  * Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
21  * IN THE SOFTWARE.
22  */
23
24 #include "i915_drv.h"
25 #include "intel_drv.h"
26
27 #define FORCEWAKE_ACK_TIMEOUT_MS 2
28
29 #define __raw_i915_read8(dev_priv__, reg__) readb((dev_priv__)->regs + (reg__))
30 #define __raw_i915_write8(dev_priv__, reg__, val__) writeb(val__, (dev_priv__)->regs + (reg__))
31
32 #define __raw_i915_read16(dev_priv__, reg__) readw((dev_priv__)->regs + (reg__))
33 #define __raw_i915_write16(dev_priv__, reg__, val__) writew(val__, (dev_priv__)->regs + (reg__))
34
35 #define __raw_i915_read32(dev_priv__, reg__) readl((dev_priv__)->regs + (reg__))
36 #define __raw_i915_write32(dev_priv__, reg__, val__) writel(val__, (dev_priv__)->regs + (reg__))
37
38 #define __raw_i915_read64(dev_priv__, reg__) readq((dev_priv__)->regs + (reg__))
39 #define __raw_i915_write64(dev_priv__, reg__, val__) writeq(val__, (dev_priv__)->regs + (reg__))
40
41 #define __raw_posting_read(dev_priv__, reg__) (void)__raw_i915_read32(dev_priv__, reg__)
42
43
44 static void __gen6_gt_wait_for_thread_c0(struct drm_i915_private *dev_priv)
45 {
46         u32 gt_thread_status_mask;
47
48         if (IS_HASWELL(dev_priv->dev))
49                 gt_thread_status_mask = GEN6_GT_THREAD_STATUS_CORE_MASK_HSW;
50         else
51                 gt_thread_status_mask = GEN6_GT_THREAD_STATUS_CORE_MASK;
52
53         /* w/a for a sporadic read returning 0 by waiting for the GT
54          * thread to wake up.
55          */
56         if (wait_for_atomic_us((__raw_i915_read32(dev_priv, GEN6_GT_THREAD_STATUS_REG) & gt_thread_status_mask) == 0, 500))
57                 DRM_ERROR("GT thread status wait timed out\n");
58 }
59
60 static void __gen6_gt_force_wake_reset(struct drm_i915_private *dev_priv)
61 {
62         __raw_i915_write32(dev_priv, FORCEWAKE, 0);
63         /* something from same cacheline, but !FORCEWAKE */
64         __raw_posting_read(dev_priv, ECOBUS);
65 }
66
67 static void __gen6_gt_force_wake_get(struct drm_i915_private *dev_priv)
68 {
69         if (wait_for_atomic((__raw_i915_read32(dev_priv, FORCEWAKE_ACK) & 1) == 0,
70                             FORCEWAKE_ACK_TIMEOUT_MS))
71                 DRM_ERROR("Timed out waiting for forcewake old ack to clear.\n");
72
73         __raw_i915_write32(dev_priv, FORCEWAKE, 1);
74         /* something from same cacheline, but !FORCEWAKE */
75         __raw_posting_read(dev_priv, ECOBUS);
76
77         if (wait_for_atomic((__raw_i915_read32(dev_priv, FORCEWAKE_ACK) & 1),
78                             FORCEWAKE_ACK_TIMEOUT_MS))
79                 DRM_ERROR("Timed out waiting for forcewake to ack request.\n");
80
81         /* WaRsForcewakeWaitTC0:snb */
82         __gen6_gt_wait_for_thread_c0(dev_priv);
83 }
84
85 static void __gen6_gt_force_wake_mt_reset(struct drm_i915_private *dev_priv)
86 {
87         __raw_i915_write32(dev_priv, FORCEWAKE_MT, _MASKED_BIT_DISABLE(0xffff));
88         /* something from same cacheline, but !FORCEWAKE_MT */
89         __raw_posting_read(dev_priv, ECOBUS);
90 }
91
92 static void __gen6_gt_force_wake_mt_get(struct drm_i915_private *dev_priv)
93 {
94         u32 forcewake_ack;
95
96         if (IS_HASWELL(dev_priv->dev))
97                 forcewake_ack = FORCEWAKE_ACK_HSW;
98         else
99                 forcewake_ack = FORCEWAKE_MT_ACK;
100
101         if (wait_for_atomic((__raw_i915_read32(dev_priv, forcewake_ack) & FORCEWAKE_KERNEL) == 0,
102                             FORCEWAKE_ACK_TIMEOUT_MS))
103                 DRM_ERROR("Timed out waiting for forcewake old ack to clear.\n");
104
105         __raw_i915_write32(dev_priv, FORCEWAKE_MT,
106                            _MASKED_BIT_ENABLE(FORCEWAKE_KERNEL));
107         /* something from same cacheline, but !FORCEWAKE_MT */
108         __raw_posting_read(dev_priv, ECOBUS);
109
110         if (wait_for_atomic((__raw_i915_read32(dev_priv, forcewake_ack) & FORCEWAKE_KERNEL),
111                             FORCEWAKE_ACK_TIMEOUT_MS))
112                 DRM_ERROR("Timed out waiting for forcewake to ack request.\n");
113
114         /* WaRsForcewakeWaitTC0:ivb,hsw */
115         __gen6_gt_wait_for_thread_c0(dev_priv);
116 }
117
118 static void gen6_gt_check_fifodbg(struct drm_i915_private *dev_priv)
119 {
120         u32 gtfifodbg;
121
122         gtfifodbg = __raw_i915_read32(dev_priv, GTFIFODBG);
123         if (WARN(gtfifodbg & GT_FIFO_CPU_ERROR_MASK,
124              "MMIO read or write has been dropped %x\n", gtfifodbg))
125                 __raw_i915_write32(dev_priv, GTFIFODBG, GT_FIFO_CPU_ERROR_MASK);
126 }
127
128 static void __gen6_gt_force_wake_put(struct drm_i915_private *dev_priv)
129 {
130         __raw_i915_write32(dev_priv, FORCEWAKE, 0);
131         /* something from same cacheline, but !FORCEWAKE */
132         __raw_posting_read(dev_priv, ECOBUS);
133         gen6_gt_check_fifodbg(dev_priv);
134 }
135
136 static void __gen6_gt_force_wake_mt_put(struct drm_i915_private *dev_priv)
137 {
138         __raw_i915_write32(dev_priv, FORCEWAKE_MT,
139                            _MASKED_BIT_DISABLE(FORCEWAKE_KERNEL));
140         /* something from same cacheline, but !FORCEWAKE_MT */
141         __raw_posting_read(dev_priv, ECOBUS);
142         gen6_gt_check_fifodbg(dev_priv);
143 }
144
145 static int __gen6_gt_wait_for_fifo(struct drm_i915_private *dev_priv)
146 {
147         int ret = 0;
148
149         if (dev_priv->uncore.fifo_count < GT_FIFO_NUM_RESERVED_ENTRIES) {
150                 int loop = 500;
151                 u32 fifo = __raw_i915_read32(dev_priv, GT_FIFO_FREE_ENTRIES);
152                 while (fifo <= GT_FIFO_NUM_RESERVED_ENTRIES && loop--) {
153                         udelay(10);
154                         fifo = __raw_i915_read32(dev_priv, GT_FIFO_FREE_ENTRIES);
155                 }
156                 if (WARN_ON(loop < 0 && fifo <= GT_FIFO_NUM_RESERVED_ENTRIES))
157                         ++ret;
158                 dev_priv->uncore.fifo_count = fifo;
159         }
160         dev_priv->uncore.fifo_count--;
161
162         return ret;
163 }
164
165 static void vlv_force_wake_reset(struct drm_i915_private *dev_priv)
166 {
167         __raw_i915_write32(dev_priv, FORCEWAKE_VLV,
168                            _MASKED_BIT_DISABLE(0xffff));
169         /* something from same cacheline, but !FORCEWAKE_VLV */
170         __raw_posting_read(dev_priv, FORCEWAKE_ACK_VLV);
171 }
172
173 static void vlv_force_wake_get(struct drm_i915_private *dev_priv)
174 {
175         if (wait_for_atomic((__raw_i915_read32(dev_priv, FORCEWAKE_ACK_VLV) & FORCEWAKE_KERNEL) == 0,
176                             FORCEWAKE_ACK_TIMEOUT_MS))
177                 DRM_ERROR("Timed out waiting for forcewake old ack to clear.\n");
178
179         __raw_i915_write32(dev_priv, FORCEWAKE_VLV,
180                            _MASKED_BIT_ENABLE(FORCEWAKE_KERNEL));
181         __raw_i915_write32(dev_priv, FORCEWAKE_MEDIA_VLV,
182                            _MASKED_BIT_ENABLE(FORCEWAKE_KERNEL));
183
184         if (wait_for_atomic((__raw_i915_read32(dev_priv, FORCEWAKE_ACK_VLV) & FORCEWAKE_KERNEL),
185                             FORCEWAKE_ACK_TIMEOUT_MS))
186                 DRM_ERROR("Timed out waiting for GT to ack forcewake request.\n");
187
188         if (wait_for_atomic((__raw_i915_read32(dev_priv, FORCEWAKE_ACK_MEDIA_VLV) &
189                              FORCEWAKE_KERNEL),
190                             FORCEWAKE_ACK_TIMEOUT_MS))
191                 DRM_ERROR("Timed out waiting for media to ack forcewake request.\n");
192
193         /* WaRsForcewakeWaitTC0:vlv */
194         __gen6_gt_wait_for_thread_c0(dev_priv);
195 }
196
197 static void vlv_force_wake_put(struct drm_i915_private *dev_priv)
198 {
199         __raw_i915_write32(dev_priv, FORCEWAKE_VLV,
200                            _MASKED_BIT_DISABLE(FORCEWAKE_KERNEL));
201         __raw_i915_write32(dev_priv, FORCEWAKE_MEDIA_VLV,
202                            _MASKED_BIT_DISABLE(FORCEWAKE_KERNEL));
203         /* The below doubles as a POSTING_READ */
204         gen6_gt_check_fifodbg(dev_priv);
205 }
206
207 static void gen6_force_wake_work(struct work_struct *work)
208 {
209         struct drm_i915_private *dev_priv =
210                 container_of(work, typeof(*dev_priv), uncore.force_wake_work.work);
211         unsigned long irqflags;
212
213         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags);
214         if (--dev_priv->uncore.forcewake_count == 0)
215                 dev_priv->uncore.funcs.force_wake_put(dev_priv);
216         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags);
217 }
218
219 void intel_uncore_early_sanitize(struct drm_device *dev)
220 {
221         struct drm_i915_private *dev_priv = dev->dev_private;
222
223         if (HAS_FPGA_DBG_UNCLAIMED(dev))
224                 __raw_i915_write32(dev_priv, FPGA_DBG, FPGA_DBG_RM_NOCLAIM);
225
226         if (IS_HASWELL(dev) &&
227             (__raw_i915_read32(dev_priv, HSW_EDRAM_PRESENT) == 1)) {
228                 /* The docs do not explain exactly how the calculation can be
229                  * made. It is somewhat guessable, but for now, it's always
230                  * 128MB.
231                  * NB: We can't write IDICR yet because we do not have gt funcs
232                  * set up */
233                 dev_priv->ellc_size = 128;
234                 DRM_INFO("Found %zuMB of eLLC\n", dev_priv->ellc_size);
235         }
236 }
237
238 static void intel_uncore_forcewake_reset(struct drm_device *dev)
239 {
240         struct drm_i915_private *dev_priv = dev->dev_private;
241
242         if (IS_VALLEYVIEW(dev)) {
243                 vlv_force_wake_reset(dev_priv);
244         } else if (INTEL_INFO(dev)->gen >= 6) {
245                 __gen6_gt_force_wake_reset(dev_priv);
246                 if (IS_IVYBRIDGE(dev) || IS_HASWELL(dev))
247                         __gen6_gt_force_wake_mt_reset(dev_priv);
248         }
249 }
250
251 void intel_uncore_sanitize(struct drm_device *dev)
252 {
253         struct drm_i915_private *dev_priv = dev->dev_private;
254         u32 reg_val;
255
256         intel_uncore_forcewake_reset(dev);
257
258         /* BIOS often leaves RC6 enabled, but disable it for hw init */
259         intel_disable_gt_powersave(dev);
260
261         /* Turn off power gate, require especially for the BIOS less system */
262         if (IS_VALLEYVIEW(dev)) {
263
264                 mutex_lock(&dev_priv->rps.hw_lock);
265                 reg_val = vlv_punit_read(dev_priv, PUNIT_REG_PWRGT_STATUS);
266
267                 if (reg_val & (RENDER_PWRGT | MEDIA_PWRGT | DISP2D_PWRGT))
268                         vlv_punit_write(dev_priv, PUNIT_REG_PWRGT_CTRL, 0x0);
269
270                 mutex_unlock(&dev_priv->rps.hw_lock);
271
272         }
273 }
274
275 /*
276  * Generally this is called implicitly by the register read function. However,
277  * if some sequence requires the GT to not power down then this function should
278  * be called at the beginning of the sequence followed by a call to
279  * gen6_gt_force_wake_put() at the end of the sequence.
280  */
281 void gen6_gt_force_wake_get(struct drm_i915_private *dev_priv)
282 {
283         unsigned long irqflags;
284
285         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags);
286         if (dev_priv->uncore.forcewake_count++ == 0)
287                 dev_priv->uncore.funcs.force_wake_get(dev_priv);
288         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags);
289 }
290
291 /*
292  * see gen6_gt_force_wake_get()
293  */
294 void gen6_gt_force_wake_put(struct drm_i915_private *dev_priv)
295 {
296         unsigned long irqflags;
297
298         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags);
299         if (--dev_priv->uncore.forcewake_count == 0) {
300                 dev_priv->uncore.forcewake_count++;
301                 mod_delayed_work(dev_priv->wq,
302                                  &dev_priv->uncore.force_wake_work,
303                                  1);
304         }
305         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags);
306 }
307
308 /* We give fast paths for the really cool registers */
309 #define NEEDS_FORCE_WAKE(dev_priv, reg) \
310         ((HAS_FORCE_WAKE((dev_priv)->dev)) && \
311          ((reg) < 0x40000) &&            \
312          ((reg) != FORCEWAKE))
313
314 static void
315 ilk_dummy_write(struct drm_i915_private *dev_priv)
316 {
317         /* WaIssueDummyWriteToWakeupFromRC6:ilk Issue a dummy write to wake up
318          * the chip from rc6 before touching it for real. MI_MODE is masked,
319          * hence harmless to write 0 into. */
320         __raw_i915_write32(dev_priv, MI_MODE, 0);
321 }
322
323 static void
324 hsw_unclaimed_reg_clear(struct drm_i915_private *dev_priv, u32 reg)
325 {
326         if (HAS_FPGA_DBG_UNCLAIMED(dev_priv->dev) &&
327             (__raw_i915_read32(dev_priv, FPGA_DBG) & FPGA_DBG_RM_NOCLAIM)) {
328                 DRM_ERROR("Unknown unclaimed register before writing to %x\n",
329                           reg);
330                 __raw_i915_write32(dev_priv, FPGA_DBG, FPGA_DBG_RM_NOCLAIM);
331         }
332 }
333
334 static void
335 hsw_unclaimed_reg_check(struct drm_i915_private *dev_priv, u32 reg)
336 {
337         if (HAS_FPGA_DBG_UNCLAIMED(dev_priv->dev) &&
338             (__raw_i915_read32(dev_priv, FPGA_DBG) & FPGA_DBG_RM_NOCLAIM)) {
339                 DRM_ERROR("Unclaimed write to %x\n", reg);
340                 __raw_i915_write32(dev_priv, FPGA_DBG, FPGA_DBG_RM_NOCLAIM);
341         }
342 }
343
344 #define REG_READ_HEADER(x) \
345         unsigned long irqflags; \
346         u##x val = 0; \
347         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags)
348
349 #define REG_READ_FOOTER \
350         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags); \
351         trace_i915_reg_rw(false, reg, val, sizeof(val), trace); \
352         return val
353
354 #define __i915_read(x) \
355 static u##x \
356 i915_read##x(struct drm_i915_private *dev_priv, off_t reg, bool trace) { \
357         REG_READ_HEADER(x); \
358         if (dev_priv->info->gen == 5) \
359                 ilk_dummy_write(dev_priv); \
360         if (NEEDS_FORCE_WAKE((dev_priv), (reg))) { \
361                 if (dev_priv->uncore.forcewake_count == 0) \
362                         dev_priv->uncore.funcs.force_wake_get(dev_priv); \
363                 val = __raw_i915_read##x(dev_priv, reg); \
364                 if (dev_priv->uncore.forcewake_count == 0) \
365                         dev_priv->uncore.funcs.force_wake_put(dev_priv); \
366         } else { \
367                 val = __raw_i915_read##x(dev_priv, reg); \
368         } \
369         REG_READ_FOOTER; \
370 }
371
372 __i915_read(8)
373 __i915_read(16)
374 __i915_read(32)
375 __i915_read(64)
376 #undef __i915_read
377 #undef REG_READ_FOOTER
378 #undef REG_READ_HEADER
379
380 #define REG_WRITE_HEADER \
381         unsigned long irqflags; \
382         trace_i915_reg_rw(true, reg, val, sizeof(val), trace); \
383         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags)
384
385 #define __i915_write(x) \
386 static void \
387 i915_write##x(struct drm_i915_private *dev_priv, off_t reg, u##x val, bool trace) { \
388         u32 __fifo_ret = 0; \
389         REG_WRITE_HEADER; \
390         if (NEEDS_FORCE_WAKE((dev_priv), (reg))) { \
391                 __fifo_ret = __gen6_gt_wait_for_fifo(dev_priv); \
392         } \
393         if (dev_priv->info->gen == 5) \
394                 ilk_dummy_write(dev_priv); \
395         hsw_unclaimed_reg_clear(dev_priv, reg); \
396         __raw_i915_write##x(dev_priv, reg, val); \
397         if (unlikely(__fifo_ret)) { \
398                 gen6_gt_check_fifodbg(dev_priv); \
399         } \
400         hsw_unclaimed_reg_check(dev_priv, reg); \
401         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags); \
402 }
403 __i915_write(8)
404 __i915_write(16)
405 __i915_write(32)
406 __i915_write(64)
407 #undef __i915_write
408 #undef REG_WRITE_HEADER
409
410 void intel_uncore_init(struct drm_device *dev)
411 {
412         struct drm_i915_private *dev_priv = dev->dev_private;
413
414         INIT_DELAYED_WORK(&dev_priv->uncore.force_wake_work,
415                           gen6_force_wake_work);
416
417         if (IS_VALLEYVIEW(dev)) {
418                 dev_priv->uncore.funcs.force_wake_get = vlv_force_wake_get;
419                 dev_priv->uncore.funcs.force_wake_put = vlv_force_wake_put;
420         } else if (IS_HASWELL(dev)) {
421                 dev_priv->uncore.funcs.force_wake_get = __gen6_gt_force_wake_mt_get;
422                 dev_priv->uncore.funcs.force_wake_put = __gen6_gt_force_wake_mt_put;
423         } else if (IS_IVYBRIDGE(dev)) {
424                 u32 ecobus;
425
426                 /* IVB configs may use multi-threaded forcewake */
427
428                 /* A small trick here - if the bios hasn't configured
429                  * MT forcewake, and if the device is in RC6, then
430                  * force_wake_mt_get will not wake the device and the
431                  * ECOBUS read will return zero. Which will be
432                  * (correctly) interpreted by the test below as MT
433                  * forcewake being disabled.
434                  */
435                 mutex_lock(&dev->struct_mutex);
436                 __gen6_gt_force_wake_mt_get(dev_priv);
437                 ecobus = __raw_i915_read32(dev_priv, ECOBUS);
438                 __gen6_gt_force_wake_mt_put(dev_priv);
439                 mutex_unlock(&dev->struct_mutex);
440
441                 if (ecobus & FORCEWAKE_MT_ENABLE) {
442                         dev_priv->uncore.funcs.force_wake_get =
443                                 __gen6_gt_force_wake_mt_get;
444                         dev_priv->uncore.funcs.force_wake_put =
445                                 __gen6_gt_force_wake_mt_put;
446                 } else {
447                         DRM_INFO("No MT forcewake available on Ivybridge, this can result in issues\n");
448                         DRM_INFO("when using vblank-synced partial screen updates.\n");
449                         dev_priv->uncore.funcs.force_wake_get =
450                                 __gen6_gt_force_wake_get;
451                         dev_priv->uncore.funcs.force_wake_put =
452                                 __gen6_gt_force_wake_put;
453                 }
454         } else if (IS_GEN6(dev)) {
455                 dev_priv->uncore.funcs.force_wake_get =
456                         __gen6_gt_force_wake_get;
457                 dev_priv->uncore.funcs.force_wake_put =
458                         __gen6_gt_force_wake_put;
459         }
460
461         dev_priv->uncore.funcs.mmio_readb  = i915_read8;
462         dev_priv->uncore.funcs.mmio_readw  = i915_read16;
463         dev_priv->uncore.funcs.mmio_readl  = i915_read32;
464         dev_priv->uncore.funcs.mmio_readq  = i915_read64;
465         dev_priv->uncore.funcs.mmio_writeb = i915_write8;
466         dev_priv->uncore.funcs.mmio_writew = i915_write16;
467         dev_priv->uncore.funcs.mmio_writel = i915_write32;
468         dev_priv->uncore.funcs.mmio_writeq = i915_write64;
469 }
470
471 void intel_uncore_fini(struct drm_device *dev)
472 {
473         struct drm_i915_private *dev_priv = dev->dev_private;
474
475         flush_delayed_work(&dev_priv->uncore.force_wake_work);
476
477         /* Paranoia: make sure we have disabled everything before we exit. */
478         intel_uncore_sanitize(dev);
479 }
480
481 static const struct register_whitelist {
482         uint64_t offset;
483         uint32_t size;
484         uint32_t gen_bitmask; /* support gens, 0x10 for 4, 0x30 for 4 and 5, etc. */
485 } whitelist[] = {
486         { RING_TIMESTAMP(RENDER_RING_BASE), 8, 0xF0 },
487 };
488
489 int i915_reg_read_ioctl(struct drm_device *dev,
490                         void *data, struct drm_file *file)
491 {
492         struct drm_i915_private *dev_priv = dev->dev_private;
493         struct drm_i915_reg_read *reg = data;
494         struct register_whitelist const *entry = whitelist;
495         int i;
496
497         for (i = 0; i < ARRAY_SIZE(whitelist); i++, entry++) {
498                 if (entry->offset == reg->offset &&
499                     (1 << INTEL_INFO(dev)->gen & entry->gen_bitmask))
500                         break;
501         }
502
503         if (i == ARRAY_SIZE(whitelist))
504                 return -EINVAL;
505
506         switch (entry->size) {
507         case 8:
508                 reg->val = I915_READ64(reg->offset);
509                 break;
510         case 4:
511                 reg->val = I915_READ(reg->offset);
512                 break;
513         case 2:
514                 reg->val = I915_READ16(reg->offset);
515                 break;
516         case 1:
517                 reg->val = I915_READ8(reg->offset);
518                 break;
519         default:
520                 WARN_ON(1);
521                 return -EINVAL;
522         }
523
524         return 0;
525 }
526
527 static int i965_reset_complete(struct drm_device *dev)
528 {
529         u8 gdrst;
530         pci_read_config_byte(dev->pdev, I965_GDRST, &gdrst);
531         return (gdrst & GRDOM_RESET_ENABLE) == 0;
532 }
533
534 static int i965_do_reset(struct drm_device *dev)
535 {
536         int ret;
537
538         /*
539          * Set the domains we want to reset (GRDOM/bits 2 and 3) as
540          * well as the reset bit (GR/bit 0).  Setting the GR bit
541          * triggers the reset; when done, the hardware will clear it.
542          */
543         pci_write_config_byte(dev->pdev, I965_GDRST,
544                               GRDOM_RENDER | GRDOM_RESET_ENABLE);
545         ret =  wait_for(i965_reset_complete(dev), 500);
546         if (ret)
547                 return ret;
548
549         /* We can't reset render&media without also resetting display ... */
550         pci_write_config_byte(dev->pdev, I965_GDRST,
551                               GRDOM_MEDIA | GRDOM_RESET_ENABLE);
552
553         ret =  wait_for(i965_reset_complete(dev), 500);
554         if (ret)
555                 return ret;
556
557         pci_write_config_byte(dev->pdev, I965_GDRST, 0);
558
559         return 0;
560 }
561
562 static int ironlake_do_reset(struct drm_device *dev)
563 {
564         struct drm_i915_private *dev_priv = dev->dev_private;
565         u32 gdrst;
566         int ret;
567
568         gdrst = I915_READ(MCHBAR_MIRROR_BASE + ILK_GDSR);
569         gdrst &= ~GRDOM_MASK;
570         I915_WRITE(MCHBAR_MIRROR_BASE + ILK_GDSR,
571                    gdrst | GRDOM_RENDER | GRDOM_RESET_ENABLE);
572         ret = wait_for(I915_READ(MCHBAR_MIRROR_BASE + ILK_GDSR) & 0x1, 500);
573         if (ret)
574                 return ret;
575
576         /* We can't reset render&media without also resetting display ... */
577         gdrst = I915_READ(MCHBAR_MIRROR_BASE + ILK_GDSR);
578         gdrst &= ~GRDOM_MASK;
579         I915_WRITE(MCHBAR_MIRROR_BASE + ILK_GDSR,
580                    gdrst | GRDOM_MEDIA | GRDOM_RESET_ENABLE);
581         return wait_for(I915_READ(MCHBAR_MIRROR_BASE + ILK_GDSR) & 0x1, 500);
582 }
583
584 static int gen6_do_reset(struct drm_device *dev)
585 {
586         struct drm_i915_private *dev_priv = dev->dev_private;
587         int     ret;
588         unsigned long irqflags;
589
590         /* Hold uncore.lock across reset to prevent any register access
591          * with forcewake not set correctly
592          */
593         spin_lock_irqsave(&dev_priv->uncore.lock, irqflags);
594
595         /* Reset the chip */
596
597         /* GEN6_GDRST is not in the gt power well, no need to check
598          * for fifo space for the write or forcewake the chip for
599          * the read
600          */
601         __raw_i915_write32(dev_priv, GEN6_GDRST, GEN6_GRDOM_FULL);
602
603         /* Spin waiting for the device to ack the reset request */
604         ret = wait_for((__raw_i915_read32(dev_priv, GEN6_GDRST) & GEN6_GRDOM_FULL) == 0, 500);
605
606         intel_uncore_forcewake_reset(dev);
607
608         /* If reset with a user forcewake, try to restore, otherwise turn it off */
609         if (dev_priv->uncore.forcewake_count)
610                 dev_priv->uncore.funcs.force_wake_get(dev_priv);
611         else
612                 dev_priv->uncore.funcs.force_wake_put(dev_priv);
613
614         /* Restore fifo count */
615         dev_priv->uncore.fifo_count = __raw_i915_read32(dev_priv, GT_FIFO_FREE_ENTRIES);
616
617         spin_unlock_irqrestore(&dev_priv->uncore.lock, irqflags);
618         return ret;
619 }
620
621 int intel_gpu_reset(struct drm_device *dev)
622 {
623         switch (INTEL_INFO(dev)->gen) {
624         case 7:
625         case 6: return gen6_do_reset(dev);
626         case 5: return ironlake_do_reset(dev);
627         case 4: return i965_do_reset(dev);
628         default: return -ENODEV;
629         }
630 }
631
632 void intel_uncore_clear_errors(struct drm_device *dev)
633 {
634         struct drm_i915_private *dev_priv = dev->dev_private;
635
636         /* XXX needs spinlock around caller's grouping */
637         if (HAS_FPGA_DBG_UNCLAIMED(dev))
638                 __raw_i915_write32(dev_priv, FPGA_DBG, FPGA_DBG_RM_NOCLAIM);
639 }
640
641 void intel_uncore_check_errors(struct drm_device *dev)
642 {
643         struct drm_i915_private *dev_priv = dev->dev_private;
644
645         if (HAS_FPGA_DBG_UNCLAIMED(dev) &&
646             (__raw_i915_read32(dev_priv, FPGA_DBG) & FPGA_DBG_RM_NOCLAIM)) {
647                 DRM_ERROR("Unclaimed register before interrupt\n");
648                 __raw_i915_write32(dev_priv, FPGA_DBG, FPGA_DBG_RM_NOCLAIM);
649         }
650 }