OSDN Git Service

drm/amdgpu/dce11: update async flip update time
[android-x86/kernel.git] / drivers / gpu / drm / amd / amdgpu / dce_v11_0.c
1 /*
2  * Copyright 2014 Advanced Micro Devices, Inc.
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 shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  */
23 #include "drmP.h"
24 #include "amdgpu.h"
25 #include "amdgpu_pm.h"
26 #include "amdgpu_i2c.h"
27 #include "vid.h"
28 #include "atom.h"
29 #include "amdgpu_atombios.h"
30 #include "atombios_crtc.h"
31 #include "atombios_encoders.h"
32 #include "amdgpu_pll.h"
33 #include "amdgpu_connectors.h"
34
35 #include "dce/dce_11_0_d.h"
36 #include "dce/dce_11_0_sh_mask.h"
37 #include "dce/dce_11_0_enum.h"
38 #include "oss/oss_3_0_d.h"
39 #include "oss/oss_3_0_sh_mask.h"
40 #include "gmc/gmc_8_1_d.h"
41 #include "gmc/gmc_8_1_sh_mask.h"
42
43 static void dce_v11_0_set_display_funcs(struct amdgpu_device *adev);
44 static void dce_v11_0_set_irq_funcs(struct amdgpu_device *adev);
45
46 static const u32 crtc_offsets[] =
47 {
48         CRTC0_REGISTER_OFFSET,
49         CRTC1_REGISTER_OFFSET,
50         CRTC2_REGISTER_OFFSET,
51         CRTC3_REGISTER_OFFSET,
52         CRTC4_REGISTER_OFFSET,
53         CRTC5_REGISTER_OFFSET,
54         CRTC6_REGISTER_OFFSET
55 };
56
57 static const u32 hpd_offsets[] =
58 {
59         HPD0_REGISTER_OFFSET,
60         HPD1_REGISTER_OFFSET,
61         HPD2_REGISTER_OFFSET,
62         HPD3_REGISTER_OFFSET,
63         HPD4_REGISTER_OFFSET,
64         HPD5_REGISTER_OFFSET
65 };
66
67 static const uint32_t dig_offsets[] = {
68         DIG0_REGISTER_OFFSET,
69         DIG1_REGISTER_OFFSET,
70         DIG2_REGISTER_OFFSET,
71         DIG3_REGISTER_OFFSET,
72         DIG4_REGISTER_OFFSET,
73         DIG5_REGISTER_OFFSET,
74         DIG6_REGISTER_OFFSET,
75         DIG7_REGISTER_OFFSET,
76         DIG8_REGISTER_OFFSET
77 };
78
79 static const struct {
80         uint32_t        reg;
81         uint32_t        vblank;
82         uint32_t        vline;
83         uint32_t        hpd;
84
85 } interrupt_status_offsets[] = { {
86         .reg = mmDISP_INTERRUPT_STATUS,
87         .vblank = DISP_INTERRUPT_STATUS__LB_D1_VBLANK_INTERRUPT_MASK,
88         .vline = DISP_INTERRUPT_STATUS__LB_D1_VLINE_INTERRUPT_MASK,
89         .hpd = DISP_INTERRUPT_STATUS__DC_HPD1_INTERRUPT_MASK
90 }, {
91         .reg = mmDISP_INTERRUPT_STATUS_CONTINUE,
92         .vblank = DISP_INTERRUPT_STATUS_CONTINUE__LB_D2_VBLANK_INTERRUPT_MASK,
93         .vline = DISP_INTERRUPT_STATUS_CONTINUE__LB_D2_VLINE_INTERRUPT_MASK,
94         .hpd = DISP_INTERRUPT_STATUS_CONTINUE__DC_HPD2_INTERRUPT_MASK
95 }, {
96         .reg = mmDISP_INTERRUPT_STATUS_CONTINUE2,
97         .vblank = DISP_INTERRUPT_STATUS_CONTINUE2__LB_D3_VBLANK_INTERRUPT_MASK,
98         .vline = DISP_INTERRUPT_STATUS_CONTINUE2__LB_D3_VLINE_INTERRUPT_MASK,
99         .hpd = DISP_INTERRUPT_STATUS_CONTINUE2__DC_HPD3_INTERRUPT_MASK
100 }, {
101         .reg = mmDISP_INTERRUPT_STATUS_CONTINUE3,
102         .vblank = DISP_INTERRUPT_STATUS_CONTINUE3__LB_D4_VBLANK_INTERRUPT_MASK,
103         .vline = DISP_INTERRUPT_STATUS_CONTINUE3__LB_D4_VLINE_INTERRUPT_MASK,
104         .hpd = DISP_INTERRUPT_STATUS_CONTINUE3__DC_HPD4_INTERRUPT_MASK
105 }, {
106         .reg = mmDISP_INTERRUPT_STATUS_CONTINUE4,
107         .vblank = DISP_INTERRUPT_STATUS_CONTINUE4__LB_D5_VBLANK_INTERRUPT_MASK,
108         .vline = DISP_INTERRUPT_STATUS_CONTINUE4__LB_D5_VLINE_INTERRUPT_MASK,
109         .hpd = DISP_INTERRUPT_STATUS_CONTINUE4__DC_HPD5_INTERRUPT_MASK
110 }, {
111         .reg = mmDISP_INTERRUPT_STATUS_CONTINUE5,
112         .vblank = DISP_INTERRUPT_STATUS_CONTINUE5__LB_D6_VBLANK_INTERRUPT_MASK,
113         .vline = DISP_INTERRUPT_STATUS_CONTINUE5__LB_D6_VLINE_INTERRUPT_MASK,
114         .hpd = DISP_INTERRUPT_STATUS_CONTINUE5__DC_HPD6_INTERRUPT_MASK
115 } };
116
117 static const u32 cz_golden_settings_a11[] =
118 {
119         mmCRTC_DOUBLE_BUFFER_CONTROL, 0x00010101, 0x00010000,
120         mmFBC_MISC, 0x1f311fff, 0x14300000,
121 };
122
123 static const u32 cz_mgcg_cgcg_init[] =
124 {
125         mmXDMA_CLOCK_GATING_CNTL, 0xffffffff, 0x00000100,
126         mmXDMA_MEM_POWER_CNTL, 0x00000101, 0x00000000,
127 };
128
129 static const u32 stoney_golden_settings_a11[] =
130 {
131         mmCRTC_DOUBLE_BUFFER_CONTROL, 0x00010101, 0x00010000,
132         mmFBC_MISC, 0x1f311fff, 0x14302000,
133 };
134
135 static const u32 polaris11_golden_settings_a11[] =
136 {
137         mmDCI_CLK_CNTL, 0x00000080, 0x00000000,
138         mmFBC_DEBUG_COMP, 0x000000f0, 0x00000070,
139         mmFBC_DEBUG1, 0xffffffff, 0x00000008,
140         mmFBC_MISC, 0x9f313fff, 0x14302008,
141         mmHDMI_CONTROL, 0x313f031f, 0x00000011,
142 };
143
144 static const u32 polaris10_golden_settings_a11[] =
145 {
146         mmDCI_CLK_CNTL, 0x00000080, 0x00000000,
147         mmFBC_DEBUG_COMP, 0x000000f0, 0x00000070,
148         mmFBC_MISC, 0x9f313fff, 0x14302008,
149         mmHDMI_CONTROL, 0x313f031f, 0x00000011,
150 };
151
152 static void dce_v11_0_init_golden_registers(struct amdgpu_device *adev)
153 {
154         switch (adev->asic_type) {
155         case CHIP_CARRIZO:
156                 amdgpu_program_register_sequence(adev,
157                                                  cz_mgcg_cgcg_init,
158                                                  (const u32)ARRAY_SIZE(cz_mgcg_cgcg_init));
159                 amdgpu_program_register_sequence(adev,
160                                                  cz_golden_settings_a11,
161                                                  (const u32)ARRAY_SIZE(cz_golden_settings_a11));
162                 break;
163         case CHIP_STONEY:
164                 amdgpu_program_register_sequence(adev,
165                                                  stoney_golden_settings_a11,
166                                                  (const u32)ARRAY_SIZE(stoney_golden_settings_a11));
167                 break;
168         case CHIP_POLARIS11:
169                 amdgpu_program_register_sequence(adev,
170                                                  polaris11_golden_settings_a11,
171                                                  (const u32)ARRAY_SIZE(polaris11_golden_settings_a11));
172                 break;
173         case CHIP_POLARIS10:
174                 amdgpu_program_register_sequence(adev,
175                                                  polaris10_golden_settings_a11,
176                                                  (const u32)ARRAY_SIZE(polaris10_golden_settings_a11));
177                 break;
178         default:
179                 break;
180         }
181 }
182
183 static u32 dce_v11_0_audio_endpt_rreg(struct amdgpu_device *adev,
184                                      u32 block_offset, u32 reg)
185 {
186         unsigned long flags;
187         u32 r;
188
189         spin_lock_irqsave(&adev->audio_endpt_idx_lock, flags);
190         WREG32(mmAZALIA_F0_CODEC_ENDPOINT_INDEX + block_offset, reg);
191         r = RREG32(mmAZALIA_F0_CODEC_ENDPOINT_DATA + block_offset);
192         spin_unlock_irqrestore(&adev->audio_endpt_idx_lock, flags);
193
194         return r;
195 }
196
197 static void dce_v11_0_audio_endpt_wreg(struct amdgpu_device *adev,
198                                       u32 block_offset, u32 reg, u32 v)
199 {
200         unsigned long flags;
201
202         spin_lock_irqsave(&adev->audio_endpt_idx_lock, flags);
203         WREG32(mmAZALIA_F0_CODEC_ENDPOINT_INDEX + block_offset, reg);
204         WREG32(mmAZALIA_F0_CODEC_ENDPOINT_DATA + block_offset, v);
205         spin_unlock_irqrestore(&adev->audio_endpt_idx_lock, flags);
206 }
207
208 static bool dce_v11_0_is_in_vblank(struct amdgpu_device *adev, int crtc)
209 {
210         if (RREG32(mmCRTC_STATUS + crtc_offsets[crtc]) &
211                         CRTC_V_BLANK_START_END__CRTC_V_BLANK_START_MASK)
212                 return true;
213         else
214                 return false;
215 }
216
217 static bool dce_v11_0_is_counter_moving(struct amdgpu_device *adev, int crtc)
218 {
219         u32 pos1, pos2;
220
221         pos1 = RREG32(mmCRTC_STATUS_POSITION + crtc_offsets[crtc]);
222         pos2 = RREG32(mmCRTC_STATUS_POSITION + crtc_offsets[crtc]);
223
224         if (pos1 != pos2)
225                 return true;
226         else
227                 return false;
228 }
229
230 /**
231  * dce_v11_0_vblank_wait - vblank wait asic callback.
232  *
233  * @adev: amdgpu_device pointer
234  * @crtc: crtc to wait for vblank on
235  *
236  * Wait for vblank on the requested crtc (evergreen+).
237  */
238 static void dce_v11_0_vblank_wait(struct amdgpu_device *adev, int crtc)
239 {
240         unsigned i = 100;
241
242         if (crtc < 0 || crtc >= adev->mode_info.num_crtc)
243                 return;
244
245         if (!(RREG32(mmCRTC_CONTROL + crtc_offsets[crtc]) & CRTC_CONTROL__CRTC_MASTER_EN_MASK))
246                 return;
247
248         /* depending on when we hit vblank, we may be close to active; if so,
249          * wait for another frame.
250          */
251         while (dce_v11_0_is_in_vblank(adev, crtc)) {
252                 if (i++ == 100) {
253                         i = 0;
254                         if (!dce_v11_0_is_counter_moving(adev, crtc))
255                                 break;
256                 }
257         }
258
259         while (!dce_v11_0_is_in_vblank(adev, crtc)) {
260                 if (i++ == 100) {
261                         i = 0;
262                         if (!dce_v11_0_is_counter_moving(adev, crtc))
263                                 break;
264                 }
265         }
266 }
267
268 static u32 dce_v11_0_vblank_get_counter(struct amdgpu_device *adev, int crtc)
269 {
270         if (crtc < 0 || crtc >= adev->mode_info.num_crtc)
271                 return 0;
272         else
273                 return RREG32(mmCRTC_STATUS_FRAME_COUNT + crtc_offsets[crtc]);
274 }
275
276 static void dce_v11_0_pageflip_interrupt_init(struct amdgpu_device *adev)
277 {
278         unsigned i;
279
280         /* Enable pflip interrupts */
281         for (i = 0; i < adev->mode_info.num_crtc; i++)
282                 amdgpu_irq_get(adev, &adev->pageflip_irq, i);
283 }
284
285 static void dce_v11_0_pageflip_interrupt_fini(struct amdgpu_device *adev)
286 {
287         unsigned i;
288
289         /* Disable pflip interrupts */
290         for (i = 0; i < adev->mode_info.num_crtc; i++)
291                 amdgpu_irq_put(adev, &adev->pageflip_irq, i);
292 }
293
294 /**
295  * dce_v11_0_page_flip - pageflip callback.
296  *
297  * @adev: amdgpu_device pointer
298  * @crtc_id: crtc to cleanup pageflip on
299  * @crtc_base: new address of the crtc (GPU MC address)
300  *
301  * Triggers the actual pageflip by updating the primary
302  * surface base address.
303  */
304 static void dce_v11_0_page_flip(struct amdgpu_device *adev,
305                                 int crtc_id, u64 crtc_base, bool async)
306 {
307         struct amdgpu_crtc *amdgpu_crtc = adev->mode_info.crtcs[crtc_id];
308         u32 tmp;
309
310         /* flip immediate for async, default is vsync */
311         tmp = RREG32(mmGRPH_FLIP_CONTROL + amdgpu_crtc->crtc_offset);
312         tmp = REG_SET_FIELD(tmp, GRPH_FLIP_CONTROL,
313                             GRPH_SURFACE_UPDATE_IMMEDIATE_EN, async ? 1 : 0);
314         WREG32(mmGRPH_FLIP_CONTROL + amdgpu_crtc->crtc_offset, tmp);
315         /* update the scanout addresses */
316         WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS_HIGH + amdgpu_crtc->crtc_offset,
317                upper_32_bits(crtc_base));
318         /* writing to the low address triggers the update */
319         WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS + amdgpu_crtc->crtc_offset,
320                lower_32_bits(crtc_base));
321         /* post the write */
322         RREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS + amdgpu_crtc->crtc_offset);
323 }
324
325 static int dce_v11_0_crtc_get_scanoutpos(struct amdgpu_device *adev, int crtc,
326                                         u32 *vbl, u32 *position)
327 {
328         if ((crtc < 0) || (crtc >= adev->mode_info.num_crtc))
329                 return -EINVAL;
330
331         *vbl = RREG32(mmCRTC_V_BLANK_START_END + crtc_offsets[crtc]);
332         *position = RREG32(mmCRTC_STATUS_POSITION + crtc_offsets[crtc]);
333
334         return 0;
335 }
336
337 /**
338  * dce_v11_0_hpd_sense - hpd sense callback.
339  *
340  * @adev: amdgpu_device pointer
341  * @hpd: hpd (hotplug detect) pin
342  *
343  * Checks if a digital monitor is connected (evergreen+).
344  * Returns true if connected, false if not connected.
345  */
346 static bool dce_v11_0_hpd_sense(struct amdgpu_device *adev,
347                                enum amdgpu_hpd_id hpd)
348 {
349         int idx;
350         bool connected = false;
351
352         switch (hpd) {
353         case AMDGPU_HPD_1:
354                 idx = 0;
355                 break;
356         case AMDGPU_HPD_2:
357                 idx = 1;
358                 break;
359         case AMDGPU_HPD_3:
360                 idx = 2;
361                 break;
362         case AMDGPU_HPD_4:
363                 idx = 3;
364                 break;
365         case AMDGPU_HPD_5:
366                 idx = 4;
367                 break;
368         case AMDGPU_HPD_6:
369                 idx = 5;
370                 break;
371         default:
372                 return connected;
373         }
374
375         if (RREG32(mmDC_HPD_INT_STATUS + hpd_offsets[idx]) &
376             DC_HPD_INT_STATUS__DC_HPD_SENSE_MASK)
377                 connected = true;
378
379         return connected;
380 }
381
382 /**
383  * dce_v11_0_hpd_set_polarity - hpd set polarity callback.
384  *
385  * @adev: amdgpu_device pointer
386  * @hpd: hpd (hotplug detect) pin
387  *
388  * Set the polarity of the hpd pin (evergreen+).
389  */
390 static void dce_v11_0_hpd_set_polarity(struct amdgpu_device *adev,
391                                       enum amdgpu_hpd_id hpd)
392 {
393         u32 tmp;
394         bool connected = dce_v11_0_hpd_sense(adev, hpd);
395         int idx;
396
397         switch (hpd) {
398         case AMDGPU_HPD_1:
399                 idx = 0;
400                 break;
401         case AMDGPU_HPD_2:
402                 idx = 1;
403                 break;
404         case AMDGPU_HPD_3:
405                 idx = 2;
406                 break;
407         case AMDGPU_HPD_4:
408                 idx = 3;
409                 break;
410         case AMDGPU_HPD_5:
411                 idx = 4;
412                 break;
413         case AMDGPU_HPD_6:
414                 idx = 5;
415                 break;
416         default:
417                 return;
418         }
419
420         tmp = RREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[idx]);
421         if (connected)
422                 tmp = REG_SET_FIELD(tmp, DC_HPD_INT_CONTROL, DC_HPD_INT_POLARITY, 0);
423         else
424                 tmp = REG_SET_FIELD(tmp, DC_HPD_INT_CONTROL, DC_HPD_INT_POLARITY, 1);
425         WREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[idx], tmp);
426 }
427
428 /**
429  * dce_v11_0_hpd_init - hpd setup callback.
430  *
431  * @adev: amdgpu_device pointer
432  *
433  * Setup the hpd pins used by the card (evergreen+).
434  * Enable the pin, set the polarity, and enable the hpd interrupts.
435  */
436 static void dce_v11_0_hpd_init(struct amdgpu_device *adev)
437 {
438         struct drm_device *dev = adev->ddev;
439         struct drm_connector *connector;
440         u32 tmp;
441         int idx;
442
443         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
444                 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
445
446                 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP ||
447                     connector->connector_type == DRM_MODE_CONNECTOR_LVDS) {
448                         /* don't try to enable hpd on eDP or LVDS avoid breaking the
449                          * aux dp channel on imac and help (but not completely fix)
450                          * https://bugzilla.redhat.com/show_bug.cgi?id=726143
451                          * also avoid interrupt storms during dpms.
452                          */
453                         continue;
454                 }
455
456                 switch (amdgpu_connector->hpd.hpd) {
457                 case AMDGPU_HPD_1:
458                         idx = 0;
459                         break;
460                 case AMDGPU_HPD_2:
461                         idx = 1;
462                         break;
463                 case AMDGPU_HPD_3:
464                         idx = 2;
465                         break;
466                 case AMDGPU_HPD_4:
467                         idx = 3;
468                         break;
469                 case AMDGPU_HPD_5:
470                         idx = 4;
471                         break;
472                 case AMDGPU_HPD_6:
473                         idx = 5;
474                         break;
475                 default:
476                         continue;
477                 }
478
479                 tmp = RREG32(mmDC_HPD_CONTROL + hpd_offsets[idx]);
480                 tmp = REG_SET_FIELD(tmp, DC_HPD_CONTROL, DC_HPD_EN, 1);
481                 WREG32(mmDC_HPD_CONTROL + hpd_offsets[idx], tmp);
482
483                 tmp = RREG32(mmDC_HPD_TOGGLE_FILT_CNTL + hpd_offsets[idx]);
484                 tmp = REG_SET_FIELD(tmp, DC_HPD_TOGGLE_FILT_CNTL,
485                                     DC_HPD_CONNECT_INT_DELAY,
486                                     AMDGPU_HPD_CONNECT_INT_DELAY_IN_MS);
487                 tmp = REG_SET_FIELD(tmp, DC_HPD_TOGGLE_FILT_CNTL,
488                                     DC_HPD_DISCONNECT_INT_DELAY,
489                                     AMDGPU_HPD_DISCONNECT_INT_DELAY_IN_MS);
490                 WREG32(mmDC_HPD_TOGGLE_FILT_CNTL + hpd_offsets[idx], tmp);
491
492                 dce_v11_0_hpd_set_polarity(adev, amdgpu_connector->hpd.hpd);
493                 amdgpu_irq_get(adev, &adev->hpd_irq, amdgpu_connector->hpd.hpd);
494         }
495 }
496
497 /**
498  * dce_v11_0_hpd_fini - hpd tear down callback.
499  *
500  * @adev: amdgpu_device pointer
501  *
502  * Tear down the hpd pins used by the card (evergreen+).
503  * Disable the hpd interrupts.
504  */
505 static void dce_v11_0_hpd_fini(struct amdgpu_device *adev)
506 {
507         struct drm_device *dev = adev->ddev;
508         struct drm_connector *connector;
509         u32 tmp;
510         int idx;
511
512         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
513                 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
514
515                 switch (amdgpu_connector->hpd.hpd) {
516                 case AMDGPU_HPD_1:
517                         idx = 0;
518                         break;
519                 case AMDGPU_HPD_2:
520                         idx = 1;
521                         break;
522                 case AMDGPU_HPD_3:
523                         idx = 2;
524                         break;
525                 case AMDGPU_HPD_4:
526                         idx = 3;
527                         break;
528                 case AMDGPU_HPD_5:
529                         idx = 4;
530                         break;
531                 case AMDGPU_HPD_6:
532                         idx = 5;
533                         break;
534                 default:
535                         continue;
536                 }
537
538                 tmp = RREG32(mmDC_HPD_CONTROL + hpd_offsets[idx]);
539                 tmp = REG_SET_FIELD(tmp, DC_HPD_CONTROL, DC_HPD_EN, 0);
540                 WREG32(mmDC_HPD_CONTROL + hpd_offsets[idx], tmp);
541
542                 amdgpu_irq_put(adev, &adev->hpd_irq, amdgpu_connector->hpd.hpd);
543         }
544 }
545
546 static u32 dce_v11_0_hpd_get_gpio_reg(struct amdgpu_device *adev)
547 {
548         return mmDC_GPIO_HPD_A;
549 }
550
551 static bool dce_v11_0_is_display_hung(struct amdgpu_device *adev)
552 {
553         u32 crtc_hung = 0;
554         u32 crtc_status[6];
555         u32 i, j, tmp;
556
557         for (i = 0; i < adev->mode_info.num_crtc; i++) {
558                 tmp = RREG32(mmCRTC_CONTROL + crtc_offsets[i]);
559                 if (REG_GET_FIELD(tmp, CRTC_CONTROL, CRTC_MASTER_EN)) {
560                         crtc_status[i] = RREG32(mmCRTC_STATUS_HV_COUNT + crtc_offsets[i]);
561                         crtc_hung |= (1 << i);
562                 }
563         }
564
565         for (j = 0; j < 10; j++) {
566                 for (i = 0; i < adev->mode_info.num_crtc; i++) {
567                         if (crtc_hung & (1 << i)) {
568                                 tmp = RREG32(mmCRTC_STATUS_HV_COUNT + crtc_offsets[i]);
569                                 if (tmp != crtc_status[i])
570                                         crtc_hung &= ~(1 << i);
571                         }
572                 }
573                 if (crtc_hung == 0)
574                         return false;
575                 udelay(100);
576         }
577
578         return true;
579 }
580
581 static void dce_v11_0_stop_mc_access(struct amdgpu_device *adev,
582                                      struct amdgpu_mode_mc_save *save)
583 {
584         u32 crtc_enabled, tmp;
585         int i;
586
587         save->vga_render_control = RREG32(mmVGA_RENDER_CONTROL);
588         save->vga_hdp_control = RREG32(mmVGA_HDP_CONTROL);
589
590         /* disable VGA render */
591         tmp = RREG32(mmVGA_RENDER_CONTROL);
592         tmp = REG_SET_FIELD(tmp, VGA_RENDER_CONTROL, VGA_VSTATUS_CNTL, 0);
593         WREG32(mmVGA_RENDER_CONTROL, tmp);
594
595         /* blank the display controllers */
596         for (i = 0; i < adev->mode_info.num_crtc; i++) {
597                 crtc_enabled = REG_GET_FIELD(RREG32(mmCRTC_CONTROL + crtc_offsets[i]),
598                                              CRTC_CONTROL, CRTC_MASTER_EN);
599                 if (crtc_enabled) {
600 #if 1
601                         save->crtc_enabled[i] = true;
602                         tmp = RREG32(mmCRTC_BLANK_CONTROL + crtc_offsets[i]);
603                         if (REG_GET_FIELD(tmp, CRTC_BLANK_CONTROL, CRTC_BLANK_DATA_EN) == 0) {
604                                 /*it is correct only for RGB ; black is 0*/
605                                 WREG32(mmCRTC_BLANK_DATA_COLOR + crtc_offsets[i], 0);
606                                 tmp = REG_SET_FIELD(tmp, CRTC_BLANK_CONTROL, CRTC_BLANK_DATA_EN, 1);
607                                 WREG32(mmCRTC_BLANK_CONTROL + crtc_offsets[i], tmp);
608                         }
609 #else
610                         /* XXX this is a hack to avoid strange behavior with EFI on certain systems */
611                         WREG32(mmCRTC_UPDATE_LOCK + crtc_offsets[i], 1);
612                         tmp = RREG32(mmCRTC_CONTROL + crtc_offsets[i]);
613                         tmp = REG_SET_FIELD(tmp, CRTC_CONTROL, CRTC_MASTER_EN, 0);
614                         WREG32(mmCRTC_CONTROL + crtc_offsets[i], tmp);
615                         WREG32(mmCRTC_UPDATE_LOCK + crtc_offsets[i], 0);
616                         save->crtc_enabled[i] = false;
617                         /* ***** */
618 #endif
619                 } else {
620                         save->crtc_enabled[i] = false;
621                 }
622         }
623 }
624
625 static void dce_v11_0_resume_mc_access(struct amdgpu_device *adev,
626                                        struct amdgpu_mode_mc_save *save)
627 {
628         u32 tmp;
629         int i;
630
631         /* update crtc base addresses */
632         for (i = 0; i < adev->mode_info.num_crtc; i++) {
633                 WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS_HIGH + crtc_offsets[i],
634                        upper_32_bits(adev->mc.vram_start));
635                 WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS + crtc_offsets[i],
636                        (u32)adev->mc.vram_start);
637
638                 if (save->crtc_enabled[i]) {
639                         tmp = RREG32(mmCRTC_BLANK_CONTROL + crtc_offsets[i]);
640                         tmp = REG_SET_FIELD(tmp, CRTC_BLANK_CONTROL, CRTC_BLANK_DATA_EN, 0);
641                         WREG32(mmCRTC_BLANK_CONTROL + crtc_offsets[i], tmp);
642                 }
643         }
644
645         WREG32(mmVGA_MEMORY_BASE_ADDRESS_HIGH, upper_32_bits(adev->mc.vram_start));
646         WREG32(mmVGA_MEMORY_BASE_ADDRESS, lower_32_bits(adev->mc.vram_start));
647
648         /* Unlock vga access */
649         WREG32(mmVGA_HDP_CONTROL, save->vga_hdp_control);
650         mdelay(1);
651         WREG32(mmVGA_RENDER_CONTROL, save->vga_render_control);
652 }
653
654 static void dce_v11_0_set_vga_render_state(struct amdgpu_device *adev,
655                                            bool render)
656 {
657         u32 tmp;
658
659         /* Lockout access through VGA aperture*/
660         tmp = RREG32(mmVGA_HDP_CONTROL);
661         if (render)
662                 tmp = REG_SET_FIELD(tmp, VGA_HDP_CONTROL, VGA_MEMORY_DISABLE, 0);
663         else
664                 tmp = REG_SET_FIELD(tmp, VGA_HDP_CONTROL, VGA_MEMORY_DISABLE, 1);
665         WREG32(mmVGA_HDP_CONTROL, tmp);
666
667         /* disable VGA render */
668         tmp = RREG32(mmVGA_RENDER_CONTROL);
669         if (render)
670                 tmp = REG_SET_FIELD(tmp, VGA_RENDER_CONTROL, VGA_VSTATUS_CNTL, 1);
671         else
672                 tmp = REG_SET_FIELD(tmp, VGA_RENDER_CONTROL, VGA_VSTATUS_CNTL, 0);
673         WREG32(mmVGA_RENDER_CONTROL, tmp);
674 }
675
676 static void dce_v11_0_program_fmt(struct drm_encoder *encoder)
677 {
678         struct drm_device *dev = encoder->dev;
679         struct amdgpu_device *adev = dev->dev_private;
680         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
681         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
682         struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
683         int bpc = 0;
684         u32 tmp = 0;
685         enum amdgpu_connector_dither dither = AMDGPU_FMT_DITHER_DISABLE;
686
687         if (connector) {
688                 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
689                 bpc = amdgpu_connector_get_monitor_bpc(connector);
690                 dither = amdgpu_connector->dither;
691         }
692
693         /* LVDS/eDP FMT is set up by atom */
694         if (amdgpu_encoder->devices & ATOM_DEVICE_LCD_SUPPORT)
695                 return;
696
697         /* not needed for analog */
698         if ((amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1) ||
699             (amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2))
700                 return;
701
702         if (bpc == 0)
703                 return;
704
705         switch (bpc) {
706         case 6:
707                 if (dither == AMDGPU_FMT_DITHER_ENABLE) {
708                         /* XXX sort out optimal dither settings */
709                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_FRAME_RANDOM_ENABLE, 1);
710                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_HIGHPASS_RANDOM_ENABLE, 1);
711                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_EN, 1);
712                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_DEPTH, 0);
713                 } else {
714                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_EN, 1);
715                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_DEPTH, 0);
716                 }
717                 break;
718         case 8:
719                 if (dither == AMDGPU_FMT_DITHER_ENABLE) {
720                         /* XXX sort out optimal dither settings */
721                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_FRAME_RANDOM_ENABLE, 1);
722                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_HIGHPASS_RANDOM_ENABLE, 1);
723                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_RGB_RANDOM_ENABLE, 1);
724                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_EN, 1);
725                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_DEPTH, 1);
726                 } else {
727                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_EN, 1);
728                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_DEPTH, 1);
729                 }
730                 break;
731         case 10:
732                 if (dither == AMDGPU_FMT_DITHER_ENABLE) {
733                         /* XXX sort out optimal dither settings */
734                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_FRAME_RANDOM_ENABLE, 1);
735                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_HIGHPASS_RANDOM_ENABLE, 1);
736                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_RGB_RANDOM_ENABLE, 1);
737                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_EN, 1);
738                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_SPATIAL_DITHER_DEPTH, 2);
739                 } else {
740                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_EN, 1);
741                         tmp = REG_SET_FIELD(tmp, FMT_BIT_DEPTH_CONTROL, FMT_TRUNCATE_DEPTH, 2);
742                 }
743                 break;
744         default:
745                 /* not needed */
746                 break;
747         }
748
749         WREG32(mmFMT_BIT_DEPTH_CONTROL + amdgpu_crtc->crtc_offset, tmp);
750 }
751
752
753 /* display watermark setup */
754 /**
755  * dce_v11_0_line_buffer_adjust - Set up the line buffer
756  *
757  * @adev: amdgpu_device pointer
758  * @amdgpu_crtc: the selected display controller
759  * @mode: the current display mode on the selected display
760  * controller
761  *
762  * Setup up the line buffer allocation for
763  * the selected display controller (CIK).
764  * Returns the line buffer size in pixels.
765  */
766 static u32 dce_v11_0_line_buffer_adjust(struct amdgpu_device *adev,
767                                        struct amdgpu_crtc *amdgpu_crtc,
768                                        struct drm_display_mode *mode)
769 {
770         u32 tmp, buffer_alloc, i, mem_cfg;
771         u32 pipe_offset = amdgpu_crtc->crtc_id;
772         /*
773          * Line Buffer Setup
774          * There are 6 line buffers, one for each display controllers.
775          * There are 3 partitions per LB. Select the number of partitions
776          * to enable based on the display width.  For display widths larger
777          * than 4096, you need use to use 2 display controllers and combine
778          * them using the stereo blender.
779          */
780         if (amdgpu_crtc->base.enabled && mode) {
781                 if (mode->crtc_hdisplay < 1920) {
782                         mem_cfg = 1;
783                         buffer_alloc = 2;
784                 } else if (mode->crtc_hdisplay < 2560) {
785                         mem_cfg = 2;
786                         buffer_alloc = 2;
787                 } else if (mode->crtc_hdisplay < 4096) {
788                         mem_cfg = 0;
789                         buffer_alloc = (adev->flags & AMD_IS_APU) ? 2 : 4;
790                 } else {
791                         DRM_DEBUG_KMS("Mode too big for LB!\n");
792                         mem_cfg = 0;
793                         buffer_alloc = (adev->flags & AMD_IS_APU) ? 2 : 4;
794                 }
795         } else {
796                 mem_cfg = 1;
797                 buffer_alloc = 0;
798         }
799
800         tmp = RREG32(mmLB_MEMORY_CTRL + amdgpu_crtc->crtc_offset);
801         tmp = REG_SET_FIELD(tmp, LB_MEMORY_CTRL, LB_MEMORY_CONFIG, mem_cfg);
802         WREG32(mmLB_MEMORY_CTRL + amdgpu_crtc->crtc_offset, tmp);
803
804         tmp = RREG32(mmPIPE0_DMIF_BUFFER_CONTROL + pipe_offset);
805         tmp = REG_SET_FIELD(tmp, PIPE0_DMIF_BUFFER_CONTROL, DMIF_BUFFERS_ALLOCATED, buffer_alloc);
806         WREG32(mmPIPE0_DMIF_BUFFER_CONTROL + pipe_offset, tmp);
807
808         for (i = 0; i < adev->usec_timeout; i++) {
809                 tmp = RREG32(mmPIPE0_DMIF_BUFFER_CONTROL + pipe_offset);
810                 if (REG_GET_FIELD(tmp, PIPE0_DMIF_BUFFER_CONTROL, DMIF_BUFFERS_ALLOCATION_COMPLETED))
811                         break;
812                 udelay(1);
813         }
814
815         if (amdgpu_crtc->base.enabled && mode) {
816                 switch (mem_cfg) {
817                 case 0:
818                 default:
819                         return 4096 * 2;
820                 case 1:
821                         return 1920 * 2;
822                 case 2:
823                         return 2560 * 2;
824                 }
825         }
826
827         /* controller not enabled, so no lb used */
828         return 0;
829 }
830
831 /**
832  * cik_get_number_of_dram_channels - get the number of dram channels
833  *
834  * @adev: amdgpu_device pointer
835  *
836  * Look up the number of video ram channels (CIK).
837  * Used for display watermark bandwidth calculations
838  * Returns the number of dram channels
839  */
840 static u32 cik_get_number_of_dram_channels(struct amdgpu_device *adev)
841 {
842         u32 tmp = RREG32(mmMC_SHARED_CHMAP);
843
844         switch (REG_GET_FIELD(tmp, MC_SHARED_CHMAP, NOOFCHAN)) {
845         case 0:
846         default:
847                 return 1;
848         case 1:
849                 return 2;
850         case 2:
851                 return 4;
852         case 3:
853                 return 8;
854         case 4:
855                 return 3;
856         case 5:
857                 return 6;
858         case 6:
859                 return 10;
860         case 7:
861                 return 12;
862         case 8:
863                 return 16;
864         }
865 }
866
867 struct dce10_wm_params {
868         u32 dram_channels; /* number of dram channels */
869         u32 yclk;          /* bandwidth per dram data pin in kHz */
870         u32 sclk;          /* engine clock in kHz */
871         u32 disp_clk;      /* display clock in kHz */
872         u32 src_width;     /* viewport width */
873         u32 active_time;   /* active display time in ns */
874         u32 blank_time;    /* blank time in ns */
875         bool interlaced;    /* mode is interlaced */
876         fixed20_12 vsc;    /* vertical scale ratio */
877         u32 num_heads;     /* number of active crtcs */
878         u32 bytes_per_pixel; /* bytes per pixel display + overlay */
879         u32 lb_size;       /* line buffer allocated to pipe */
880         u32 vtaps;         /* vertical scaler taps */
881 };
882
883 /**
884  * dce_v11_0_dram_bandwidth - get the dram bandwidth
885  *
886  * @wm: watermark calculation data
887  *
888  * Calculate the raw dram bandwidth (CIK).
889  * Used for display watermark bandwidth calculations
890  * Returns the dram bandwidth in MBytes/s
891  */
892 static u32 dce_v11_0_dram_bandwidth(struct dce10_wm_params *wm)
893 {
894         /* Calculate raw DRAM Bandwidth */
895         fixed20_12 dram_efficiency; /* 0.7 */
896         fixed20_12 yclk, dram_channels, bandwidth;
897         fixed20_12 a;
898
899         a.full = dfixed_const(1000);
900         yclk.full = dfixed_const(wm->yclk);
901         yclk.full = dfixed_div(yclk, a);
902         dram_channels.full = dfixed_const(wm->dram_channels * 4);
903         a.full = dfixed_const(10);
904         dram_efficiency.full = dfixed_const(7);
905         dram_efficiency.full = dfixed_div(dram_efficiency, a);
906         bandwidth.full = dfixed_mul(dram_channels, yclk);
907         bandwidth.full = dfixed_mul(bandwidth, dram_efficiency);
908
909         return dfixed_trunc(bandwidth);
910 }
911
912 /**
913  * dce_v11_0_dram_bandwidth_for_display - get the dram bandwidth for display
914  *
915  * @wm: watermark calculation data
916  *
917  * Calculate the dram bandwidth used for display (CIK).
918  * Used for display watermark bandwidth calculations
919  * Returns the dram bandwidth for display in MBytes/s
920  */
921 static u32 dce_v11_0_dram_bandwidth_for_display(struct dce10_wm_params *wm)
922 {
923         /* Calculate DRAM Bandwidth and the part allocated to display. */
924         fixed20_12 disp_dram_allocation; /* 0.3 to 0.7 */
925         fixed20_12 yclk, dram_channels, bandwidth;
926         fixed20_12 a;
927
928         a.full = dfixed_const(1000);
929         yclk.full = dfixed_const(wm->yclk);
930         yclk.full = dfixed_div(yclk, a);
931         dram_channels.full = dfixed_const(wm->dram_channels * 4);
932         a.full = dfixed_const(10);
933         disp_dram_allocation.full = dfixed_const(3); /* XXX worse case value 0.3 */
934         disp_dram_allocation.full = dfixed_div(disp_dram_allocation, a);
935         bandwidth.full = dfixed_mul(dram_channels, yclk);
936         bandwidth.full = dfixed_mul(bandwidth, disp_dram_allocation);
937
938         return dfixed_trunc(bandwidth);
939 }
940
941 /**
942  * dce_v11_0_data_return_bandwidth - get the data return bandwidth
943  *
944  * @wm: watermark calculation data
945  *
946  * Calculate the data return bandwidth used for display (CIK).
947  * Used for display watermark bandwidth calculations
948  * Returns the data return bandwidth in MBytes/s
949  */
950 static u32 dce_v11_0_data_return_bandwidth(struct dce10_wm_params *wm)
951 {
952         /* Calculate the display Data return Bandwidth */
953         fixed20_12 return_efficiency; /* 0.8 */
954         fixed20_12 sclk, bandwidth;
955         fixed20_12 a;
956
957         a.full = dfixed_const(1000);
958         sclk.full = dfixed_const(wm->sclk);
959         sclk.full = dfixed_div(sclk, a);
960         a.full = dfixed_const(10);
961         return_efficiency.full = dfixed_const(8);
962         return_efficiency.full = dfixed_div(return_efficiency, a);
963         a.full = dfixed_const(32);
964         bandwidth.full = dfixed_mul(a, sclk);
965         bandwidth.full = dfixed_mul(bandwidth, return_efficiency);
966
967         return dfixed_trunc(bandwidth);
968 }
969
970 /**
971  * dce_v11_0_dmif_request_bandwidth - get the dmif bandwidth
972  *
973  * @wm: watermark calculation data
974  *
975  * Calculate the dmif bandwidth used for display (CIK).
976  * Used for display watermark bandwidth calculations
977  * Returns the dmif bandwidth in MBytes/s
978  */
979 static u32 dce_v11_0_dmif_request_bandwidth(struct dce10_wm_params *wm)
980 {
981         /* Calculate the DMIF Request Bandwidth */
982         fixed20_12 disp_clk_request_efficiency; /* 0.8 */
983         fixed20_12 disp_clk, bandwidth;
984         fixed20_12 a, b;
985
986         a.full = dfixed_const(1000);
987         disp_clk.full = dfixed_const(wm->disp_clk);
988         disp_clk.full = dfixed_div(disp_clk, a);
989         a.full = dfixed_const(32);
990         b.full = dfixed_mul(a, disp_clk);
991
992         a.full = dfixed_const(10);
993         disp_clk_request_efficiency.full = dfixed_const(8);
994         disp_clk_request_efficiency.full = dfixed_div(disp_clk_request_efficiency, a);
995
996         bandwidth.full = dfixed_mul(b, disp_clk_request_efficiency);
997
998         return dfixed_trunc(bandwidth);
999 }
1000
1001 /**
1002  * dce_v11_0_available_bandwidth - get the min available bandwidth
1003  *
1004  * @wm: watermark calculation data
1005  *
1006  * Calculate the min available bandwidth used for display (CIK).
1007  * Used for display watermark bandwidth calculations
1008  * Returns the min available bandwidth in MBytes/s
1009  */
1010 static u32 dce_v11_0_available_bandwidth(struct dce10_wm_params *wm)
1011 {
1012         /* Calculate the Available bandwidth. Display can use this temporarily but not in average. */
1013         u32 dram_bandwidth = dce_v11_0_dram_bandwidth(wm);
1014         u32 data_return_bandwidth = dce_v11_0_data_return_bandwidth(wm);
1015         u32 dmif_req_bandwidth = dce_v11_0_dmif_request_bandwidth(wm);
1016
1017         return min(dram_bandwidth, min(data_return_bandwidth, dmif_req_bandwidth));
1018 }
1019
1020 /**
1021  * dce_v11_0_average_bandwidth - get the average available bandwidth
1022  *
1023  * @wm: watermark calculation data
1024  *
1025  * Calculate the average available bandwidth used for display (CIK).
1026  * Used for display watermark bandwidth calculations
1027  * Returns the average available bandwidth in MBytes/s
1028  */
1029 static u32 dce_v11_0_average_bandwidth(struct dce10_wm_params *wm)
1030 {
1031         /* Calculate the display mode Average Bandwidth
1032          * DisplayMode should contain the source and destination dimensions,
1033          * timing, etc.
1034          */
1035         fixed20_12 bpp;
1036         fixed20_12 line_time;
1037         fixed20_12 src_width;
1038         fixed20_12 bandwidth;
1039         fixed20_12 a;
1040
1041         a.full = dfixed_const(1000);
1042         line_time.full = dfixed_const(wm->active_time + wm->blank_time);
1043         line_time.full = dfixed_div(line_time, a);
1044         bpp.full = dfixed_const(wm->bytes_per_pixel);
1045         src_width.full = dfixed_const(wm->src_width);
1046         bandwidth.full = dfixed_mul(src_width, bpp);
1047         bandwidth.full = dfixed_mul(bandwidth, wm->vsc);
1048         bandwidth.full = dfixed_div(bandwidth, line_time);
1049
1050         return dfixed_trunc(bandwidth);
1051 }
1052
1053 /**
1054  * dce_v11_0_latency_watermark - get the latency watermark
1055  *
1056  * @wm: watermark calculation data
1057  *
1058  * Calculate the latency watermark (CIK).
1059  * Used for display watermark bandwidth calculations
1060  * Returns the latency watermark in ns
1061  */
1062 static u32 dce_v11_0_latency_watermark(struct dce10_wm_params *wm)
1063 {
1064         /* First calculate the latency in ns */
1065         u32 mc_latency = 2000; /* 2000 ns. */
1066         u32 available_bandwidth = dce_v11_0_available_bandwidth(wm);
1067         u32 worst_chunk_return_time = (512 * 8 * 1000) / available_bandwidth;
1068         u32 cursor_line_pair_return_time = (128 * 4 * 1000) / available_bandwidth;
1069         u32 dc_latency = 40000000 / wm->disp_clk; /* dc pipe latency */
1070         u32 other_heads_data_return_time = ((wm->num_heads + 1) * worst_chunk_return_time) +
1071                 (wm->num_heads * cursor_line_pair_return_time);
1072         u32 latency = mc_latency + other_heads_data_return_time + dc_latency;
1073         u32 max_src_lines_per_dst_line, lb_fill_bw, line_fill_time;
1074         u32 tmp, dmif_size = 12288;
1075         fixed20_12 a, b, c;
1076
1077         if (wm->num_heads == 0)
1078                 return 0;
1079
1080         a.full = dfixed_const(2);
1081         b.full = dfixed_const(1);
1082         if ((wm->vsc.full > a.full) ||
1083             ((wm->vsc.full > b.full) && (wm->vtaps >= 3)) ||
1084             (wm->vtaps >= 5) ||
1085             ((wm->vsc.full >= a.full) && wm->interlaced))
1086                 max_src_lines_per_dst_line = 4;
1087         else
1088                 max_src_lines_per_dst_line = 2;
1089
1090         a.full = dfixed_const(available_bandwidth);
1091         b.full = dfixed_const(wm->num_heads);
1092         a.full = dfixed_div(a, b);
1093
1094         b.full = dfixed_const(mc_latency + 512);
1095         c.full = dfixed_const(wm->disp_clk);
1096         b.full = dfixed_div(b, c);
1097
1098         c.full = dfixed_const(dmif_size);
1099         b.full = dfixed_div(c, b);
1100
1101         tmp = min(dfixed_trunc(a), dfixed_trunc(b));
1102
1103         b.full = dfixed_const(1000);
1104         c.full = dfixed_const(wm->disp_clk);
1105         b.full = dfixed_div(c, b);
1106         c.full = dfixed_const(wm->bytes_per_pixel);
1107         b.full = dfixed_mul(b, c);
1108
1109         lb_fill_bw = min(tmp, dfixed_trunc(b));
1110
1111         a.full = dfixed_const(max_src_lines_per_dst_line * wm->src_width * wm->bytes_per_pixel);
1112         b.full = dfixed_const(1000);
1113         c.full = dfixed_const(lb_fill_bw);
1114         b.full = dfixed_div(c, b);
1115         a.full = dfixed_div(a, b);
1116         line_fill_time = dfixed_trunc(a);
1117
1118         if (line_fill_time < wm->active_time)
1119                 return latency;
1120         else
1121                 return latency + (line_fill_time - wm->active_time);
1122
1123 }
1124
1125 /**
1126  * dce_v11_0_average_bandwidth_vs_dram_bandwidth_for_display - check
1127  * average and available dram bandwidth
1128  *
1129  * @wm: watermark calculation data
1130  *
1131  * Check if the display average bandwidth fits in the display
1132  * dram bandwidth (CIK).
1133  * Used for display watermark bandwidth calculations
1134  * Returns true if the display fits, false if not.
1135  */
1136 static bool dce_v11_0_average_bandwidth_vs_dram_bandwidth_for_display(struct dce10_wm_params *wm)
1137 {
1138         if (dce_v11_0_average_bandwidth(wm) <=
1139             (dce_v11_0_dram_bandwidth_for_display(wm) / wm->num_heads))
1140                 return true;
1141         else
1142                 return false;
1143 }
1144
1145 /**
1146  * dce_v11_0_average_bandwidth_vs_available_bandwidth - check
1147  * average and available bandwidth
1148  *
1149  * @wm: watermark calculation data
1150  *
1151  * Check if the display average bandwidth fits in the display
1152  * available bandwidth (CIK).
1153  * Used for display watermark bandwidth calculations
1154  * Returns true if the display fits, false if not.
1155  */
1156 static bool dce_v11_0_average_bandwidth_vs_available_bandwidth(struct dce10_wm_params *wm)
1157 {
1158         if (dce_v11_0_average_bandwidth(wm) <=
1159             (dce_v11_0_available_bandwidth(wm) / wm->num_heads))
1160                 return true;
1161         else
1162                 return false;
1163 }
1164
1165 /**
1166  * dce_v11_0_check_latency_hiding - check latency hiding
1167  *
1168  * @wm: watermark calculation data
1169  *
1170  * Check latency hiding (CIK).
1171  * Used for display watermark bandwidth calculations
1172  * Returns true if the display fits, false if not.
1173  */
1174 static bool dce_v11_0_check_latency_hiding(struct dce10_wm_params *wm)
1175 {
1176         u32 lb_partitions = wm->lb_size / wm->src_width;
1177         u32 line_time = wm->active_time + wm->blank_time;
1178         u32 latency_tolerant_lines;
1179         u32 latency_hiding;
1180         fixed20_12 a;
1181
1182         a.full = dfixed_const(1);
1183         if (wm->vsc.full > a.full)
1184                 latency_tolerant_lines = 1;
1185         else {
1186                 if (lb_partitions <= (wm->vtaps + 1))
1187                         latency_tolerant_lines = 1;
1188                 else
1189                         latency_tolerant_lines = 2;
1190         }
1191
1192         latency_hiding = (latency_tolerant_lines * line_time + wm->blank_time);
1193
1194         if (dce_v11_0_latency_watermark(wm) <= latency_hiding)
1195                 return true;
1196         else
1197                 return false;
1198 }
1199
1200 /**
1201  * dce_v11_0_program_watermarks - program display watermarks
1202  *
1203  * @adev: amdgpu_device pointer
1204  * @amdgpu_crtc: the selected display controller
1205  * @lb_size: line buffer size
1206  * @num_heads: number of display controllers in use
1207  *
1208  * Calculate and program the display watermarks for the
1209  * selected display controller (CIK).
1210  */
1211 static void dce_v11_0_program_watermarks(struct amdgpu_device *adev,
1212                                         struct amdgpu_crtc *amdgpu_crtc,
1213                                         u32 lb_size, u32 num_heads)
1214 {
1215         struct drm_display_mode *mode = &amdgpu_crtc->base.mode;
1216         struct dce10_wm_params wm_low, wm_high;
1217         u32 pixel_period;
1218         u32 line_time = 0;
1219         u32 latency_watermark_a = 0, latency_watermark_b = 0;
1220         u32 tmp, wm_mask, lb_vblank_lead_lines = 0;
1221
1222         if (amdgpu_crtc->base.enabled && num_heads && mode) {
1223                 pixel_period = 1000000 / (u32)mode->clock;
1224                 line_time = min((u32)mode->crtc_htotal * pixel_period, (u32)65535);
1225
1226                 /* watermark for high clocks */
1227                 if (adev->pm.dpm_enabled) {
1228                         wm_high.yclk =
1229                                 amdgpu_dpm_get_mclk(adev, false) * 10;
1230                         wm_high.sclk =
1231                                 amdgpu_dpm_get_sclk(adev, false) * 10;
1232                 } else {
1233                         wm_high.yclk = adev->pm.current_mclk * 10;
1234                         wm_high.sclk = adev->pm.current_sclk * 10;
1235                 }
1236
1237                 wm_high.disp_clk = mode->clock;
1238                 wm_high.src_width = mode->crtc_hdisplay;
1239                 wm_high.active_time = mode->crtc_hdisplay * pixel_period;
1240                 wm_high.blank_time = line_time - wm_high.active_time;
1241                 wm_high.interlaced = false;
1242                 if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1243                         wm_high.interlaced = true;
1244                 wm_high.vsc = amdgpu_crtc->vsc;
1245                 wm_high.vtaps = 1;
1246                 if (amdgpu_crtc->rmx_type != RMX_OFF)
1247                         wm_high.vtaps = 2;
1248                 wm_high.bytes_per_pixel = 4; /* XXX: get this from fb config */
1249                 wm_high.lb_size = lb_size;
1250                 wm_high.dram_channels = cik_get_number_of_dram_channels(adev);
1251                 wm_high.num_heads = num_heads;
1252
1253                 /* set for high clocks */
1254                 latency_watermark_a = min(dce_v11_0_latency_watermark(&wm_high), (u32)65535);
1255
1256                 /* possibly force display priority to high */
1257                 /* should really do this at mode validation time... */
1258                 if (!dce_v11_0_average_bandwidth_vs_dram_bandwidth_for_display(&wm_high) ||
1259                     !dce_v11_0_average_bandwidth_vs_available_bandwidth(&wm_high) ||
1260                     !dce_v11_0_check_latency_hiding(&wm_high) ||
1261                     (adev->mode_info.disp_priority == 2)) {
1262                         DRM_DEBUG_KMS("force priority to high\n");
1263                 }
1264
1265                 /* watermark for low clocks */
1266                 if (adev->pm.dpm_enabled) {
1267                         wm_low.yclk =
1268                                 amdgpu_dpm_get_mclk(adev, true) * 10;
1269                         wm_low.sclk =
1270                                 amdgpu_dpm_get_sclk(adev, true) * 10;
1271                 } else {
1272                         wm_low.yclk = adev->pm.current_mclk * 10;
1273                         wm_low.sclk = adev->pm.current_sclk * 10;
1274                 }
1275
1276                 wm_low.disp_clk = mode->clock;
1277                 wm_low.src_width = mode->crtc_hdisplay;
1278                 wm_low.active_time = mode->crtc_hdisplay * pixel_period;
1279                 wm_low.blank_time = line_time - wm_low.active_time;
1280                 wm_low.interlaced = false;
1281                 if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1282                         wm_low.interlaced = true;
1283                 wm_low.vsc = amdgpu_crtc->vsc;
1284                 wm_low.vtaps = 1;
1285                 if (amdgpu_crtc->rmx_type != RMX_OFF)
1286                         wm_low.vtaps = 2;
1287                 wm_low.bytes_per_pixel = 4; /* XXX: get this from fb config */
1288                 wm_low.lb_size = lb_size;
1289                 wm_low.dram_channels = cik_get_number_of_dram_channels(adev);
1290                 wm_low.num_heads = num_heads;
1291
1292                 /* set for low clocks */
1293                 latency_watermark_b = min(dce_v11_0_latency_watermark(&wm_low), (u32)65535);
1294
1295                 /* possibly force display priority to high */
1296                 /* should really do this at mode validation time... */
1297                 if (!dce_v11_0_average_bandwidth_vs_dram_bandwidth_for_display(&wm_low) ||
1298                     !dce_v11_0_average_bandwidth_vs_available_bandwidth(&wm_low) ||
1299                     !dce_v11_0_check_latency_hiding(&wm_low) ||
1300                     (adev->mode_info.disp_priority == 2)) {
1301                         DRM_DEBUG_KMS("force priority to high\n");
1302                 }
1303                 lb_vblank_lead_lines = DIV_ROUND_UP(lb_size, mode->crtc_hdisplay);
1304         }
1305
1306         /* select wm A */
1307         wm_mask = RREG32(mmDPG_WATERMARK_MASK_CONTROL + amdgpu_crtc->crtc_offset);
1308         tmp = REG_SET_FIELD(wm_mask, DPG_WATERMARK_MASK_CONTROL, URGENCY_WATERMARK_MASK, 1);
1309         WREG32(mmDPG_WATERMARK_MASK_CONTROL + amdgpu_crtc->crtc_offset, tmp);
1310         tmp = RREG32(mmDPG_PIPE_URGENCY_CONTROL + amdgpu_crtc->crtc_offset);
1311         tmp = REG_SET_FIELD(tmp, DPG_PIPE_URGENCY_CONTROL, URGENCY_LOW_WATERMARK, latency_watermark_a);
1312         tmp = REG_SET_FIELD(tmp, DPG_PIPE_URGENCY_CONTROL, URGENCY_HIGH_WATERMARK, line_time);
1313         WREG32(mmDPG_PIPE_URGENCY_CONTROL + amdgpu_crtc->crtc_offset, tmp);
1314         /* select wm B */
1315         tmp = REG_SET_FIELD(wm_mask, DPG_WATERMARK_MASK_CONTROL, URGENCY_WATERMARK_MASK, 2);
1316         WREG32(mmDPG_WATERMARK_MASK_CONTROL + amdgpu_crtc->crtc_offset, tmp);
1317         tmp = RREG32(mmDPG_PIPE_URGENCY_CONTROL + amdgpu_crtc->crtc_offset);
1318         tmp = REG_SET_FIELD(tmp, DPG_PIPE_URGENCY_CONTROL, URGENCY_LOW_WATERMARK, latency_watermark_b);
1319         tmp = REG_SET_FIELD(tmp, DPG_PIPE_URGENCY_CONTROL, URGENCY_HIGH_WATERMARK, line_time);
1320         WREG32(mmDPG_PIPE_URGENCY_CONTROL + amdgpu_crtc->crtc_offset, tmp);
1321         /* restore original selection */
1322         WREG32(mmDPG_WATERMARK_MASK_CONTROL + amdgpu_crtc->crtc_offset, wm_mask);
1323
1324         /* save values for DPM */
1325         amdgpu_crtc->line_time = line_time;
1326         amdgpu_crtc->wm_high = latency_watermark_a;
1327         amdgpu_crtc->wm_low = latency_watermark_b;
1328         /* Save number of lines the linebuffer leads before the scanout */
1329         amdgpu_crtc->lb_vblank_lead_lines = lb_vblank_lead_lines;
1330 }
1331
1332 /**
1333  * dce_v11_0_bandwidth_update - program display watermarks
1334  *
1335  * @adev: amdgpu_device pointer
1336  *
1337  * Calculate and program the display watermarks and line
1338  * buffer allocation (CIK).
1339  */
1340 static void dce_v11_0_bandwidth_update(struct amdgpu_device *adev)
1341 {
1342         struct drm_display_mode *mode = NULL;
1343         u32 num_heads = 0, lb_size;
1344         int i;
1345
1346         amdgpu_update_display_priority(adev);
1347
1348         for (i = 0; i < adev->mode_info.num_crtc; i++) {
1349                 if (adev->mode_info.crtcs[i]->base.enabled)
1350                         num_heads++;
1351         }
1352         for (i = 0; i < adev->mode_info.num_crtc; i++) {
1353                 mode = &adev->mode_info.crtcs[i]->base.mode;
1354                 lb_size = dce_v11_0_line_buffer_adjust(adev, adev->mode_info.crtcs[i], mode);
1355                 dce_v11_0_program_watermarks(adev, adev->mode_info.crtcs[i],
1356                                             lb_size, num_heads);
1357         }
1358 }
1359
1360 static void dce_v11_0_audio_get_connected_pins(struct amdgpu_device *adev)
1361 {
1362         int i;
1363         u32 offset, tmp;
1364
1365         for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
1366                 offset = adev->mode_info.audio.pin[i].offset;
1367                 tmp = RREG32_AUDIO_ENDPT(offset,
1368                                          ixAZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_CONFIGURATION_DEFAULT);
1369                 if (((tmp &
1370                 AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_CONFIGURATION_DEFAULT__PORT_CONNECTIVITY_MASK) >>
1371                 AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_CONFIGURATION_DEFAULT__PORT_CONNECTIVITY__SHIFT) == 1)
1372                         adev->mode_info.audio.pin[i].connected = false;
1373                 else
1374                         adev->mode_info.audio.pin[i].connected = true;
1375         }
1376 }
1377
1378 static struct amdgpu_audio_pin *dce_v11_0_audio_get_pin(struct amdgpu_device *adev)
1379 {
1380         int i;
1381
1382         dce_v11_0_audio_get_connected_pins(adev);
1383
1384         for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
1385                 if (adev->mode_info.audio.pin[i].connected)
1386                         return &adev->mode_info.audio.pin[i];
1387         }
1388         DRM_ERROR("No connected audio pins found!\n");
1389         return NULL;
1390 }
1391
1392 static void dce_v11_0_afmt_audio_select_pin(struct drm_encoder *encoder)
1393 {
1394         struct amdgpu_device *adev = encoder->dev->dev_private;
1395         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1396         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1397         u32 tmp;
1398
1399         if (!dig || !dig->afmt || !dig->afmt->pin)
1400                 return;
1401
1402         tmp = RREG32(mmAFMT_AUDIO_SRC_CONTROL + dig->afmt->offset);
1403         tmp = REG_SET_FIELD(tmp, AFMT_AUDIO_SRC_CONTROL, AFMT_AUDIO_SRC_SELECT, dig->afmt->pin->id);
1404         WREG32(mmAFMT_AUDIO_SRC_CONTROL + dig->afmt->offset, tmp);
1405 }
1406
1407 static void dce_v11_0_audio_write_latency_fields(struct drm_encoder *encoder,
1408                                                 struct drm_display_mode *mode)
1409 {
1410         struct amdgpu_device *adev = encoder->dev->dev_private;
1411         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1412         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1413         struct drm_connector *connector;
1414         struct amdgpu_connector *amdgpu_connector = NULL;
1415         u32 tmp;
1416         int interlace = 0;
1417
1418         if (!dig || !dig->afmt || !dig->afmt->pin)
1419                 return;
1420
1421         list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
1422                 if (connector->encoder == encoder) {
1423                         amdgpu_connector = to_amdgpu_connector(connector);
1424                         break;
1425                 }
1426         }
1427
1428         if (!amdgpu_connector) {
1429                 DRM_ERROR("Couldn't find encoder's connector\n");
1430                 return;
1431         }
1432
1433         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1434                 interlace = 1;
1435         if (connector->latency_present[interlace]) {
1436                 tmp = REG_SET_FIELD(0, AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC,
1437                                     VIDEO_LIPSYNC, connector->video_latency[interlace]);
1438                 tmp = REG_SET_FIELD(0, AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC,
1439                                     AUDIO_LIPSYNC, connector->audio_latency[interlace]);
1440         } else {
1441                 tmp = REG_SET_FIELD(0, AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC,
1442                                     VIDEO_LIPSYNC, 0);
1443                 tmp = REG_SET_FIELD(0, AZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC,
1444                                     AUDIO_LIPSYNC, 0);
1445         }
1446         WREG32_AUDIO_ENDPT(dig->afmt->pin->offset,
1447                            ixAZALIA_F0_CODEC_PIN_CONTROL_RESPONSE_LIPSYNC, tmp);
1448 }
1449
1450 static void dce_v11_0_audio_write_speaker_allocation(struct drm_encoder *encoder)
1451 {
1452         struct amdgpu_device *adev = encoder->dev->dev_private;
1453         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1454         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1455         struct drm_connector *connector;
1456         struct amdgpu_connector *amdgpu_connector = NULL;
1457         u32 tmp;
1458         u8 *sadb = NULL;
1459         int sad_count;
1460
1461         if (!dig || !dig->afmt || !dig->afmt->pin)
1462                 return;
1463
1464         list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
1465                 if (connector->encoder == encoder) {
1466                         amdgpu_connector = to_amdgpu_connector(connector);
1467                         break;
1468                 }
1469         }
1470
1471         if (!amdgpu_connector) {
1472                 DRM_ERROR("Couldn't find encoder's connector\n");
1473                 return;
1474         }
1475
1476         sad_count = drm_edid_to_speaker_allocation(amdgpu_connector_edid(connector), &sadb);
1477         if (sad_count < 0) {
1478                 DRM_ERROR("Couldn't read Speaker Allocation Data Block: %d\n", sad_count);
1479                 sad_count = 0;
1480         }
1481
1482         /* program the speaker allocation */
1483         tmp = RREG32_AUDIO_ENDPT(dig->afmt->pin->offset,
1484                                  ixAZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER);
1485         tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER,
1486                             DP_CONNECTION, 0);
1487         /* set HDMI mode */
1488         tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER,
1489                             HDMI_CONNECTION, 1);
1490         if (sad_count)
1491                 tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER,
1492                                     SPEAKER_ALLOCATION, sadb[0]);
1493         else
1494                 tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER,
1495                                     SPEAKER_ALLOCATION, 5); /* stereo */
1496         WREG32_AUDIO_ENDPT(dig->afmt->pin->offset,
1497                            ixAZALIA_F0_CODEC_PIN_CONTROL_CHANNEL_SPEAKER, tmp);
1498
1499         kfree(sadb);
1500 }
1501
1502 static void dce_v11_0_audio_write_sad_regs(struct drm_encoder *encoder)
1503 {
1504         struct amdgpu_device *adev = encoder->dev->dev_private;
1505         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1506         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1507         struct drm_connector *connector;
1508         struct amdgpu_connector *amdgpu_connector = NULL;
1509         struct cea_sad *sads;
1510         int i, sad_count;
1511
1512         static const u16 eld_reg_to_type[][2] = {
1513                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0, HDMI_AUDIO_CODING_TYPE_PCM },
1514                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR1, HDMI_AUDIO_CODING_TYPE_AC3 },
1515                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR2, HDMI_AUDIO_CODING_TYPE_MPEG1 },
1516                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR3, HDMI_AUDIO_CODING_TYPE_MP3 },
1517                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR4, HDMI_AUDIO_CODING_TYPE_MPEG2 },
1518                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR5, HDMI_AUDIO_CODING_TYPE_AAC_LC },
1519                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR6, HDMI_AUDIO_CODING_TYPE_DTS },
1520                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR7, HDMI_AUDIO_CODING_TYPE_ATRAC },
1521                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR9, HDMI_AUDIO_CODING_TYPE_EAC3 },
1522                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR10, HDMI_AUDIO_CODING_TYPE_DTS_HD },
1523                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR11, HDMI_AUDIO_CODING_TYPE_MLP },
1524                 { ixAZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO },
1525         };
1526
1527         if (!dig || !dig->afmt || !dig->afmt->pin)
1528                 return;
1529
1530         list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
1531                 if (connector->encoder == encoder) {
1532                         amdgpu_connector = to_amdgpu_connector(connector);
1533                         break;
1534                 }
1535         }
1536
1537         if (!amdgpu_connector) {
1538                 DRM_ERROR("Couldn't find encoder's connector\n");
1539                 return;
1540         }
1541
1542         sad_count = drm_edid_to_sad(amdgpu_connector_edid(connector), &sads);
1543         if (sad_count <= 0) {
1544                 DRM_ERROR("Couldn't read SADs: %d\n", sad_count);
1545                 return;
1546         }
1547         BUG_ON(!sads);
1548
1549         for (i = 0; i < ARRAY_SIZE(eld_reg_to_type); i++) {
1550                 u32 tmp = 0;
1551                 u8 stereo_freqs = 0;
1552                 int max_channels = -1;
1553                 int j;
1554
1555                 for (j = 0; j < sad_count; j++) {
1556                         struct cea_sad *sad = &sads[j];
1557
1558                         if (sad->format == eld_reg_to_type[i][1]) {
1559                                 if (sad->channels > max_channels) {
1560                                         tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0,
1561                                                             MAX_CHANNELS, sad->channels);
1562                                         tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0,
1563                                                             DESCRIPTOR_BYTE_2, sad->byte2);
1564                                         tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0,
1565                                                             SUPPORTED_FREQUENCIES, sad->freq);
1566                                         max_channels = sad->channels;
1567                                 }
1568
1569                                 if (sad->format == HDMI_AUDIO_CODING_TYPE_PCM)
1570                                         stereo_freqs |= sad->freq;
1571                                 else
1572                                         break;
1573                         }
1574                 }
1575
1576                 tmp = REG_SET_FIELD(tmp, AZALIA_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR0,
1577                                     SUPPORTED_FREQUENCIES_STEREO, stereo_freqs);
1578                 WREG32_AUDIO_ENDPT(dig->afmt->pin->offset, eld_reg_to_type[i][0], tmp);
1579         }
1580
1581         kfree(sads);
1582 }
1583
1584 static void dce_v11_0_audio_enable(struct amdgpu_device *adev,
1585                                   struct amdgpu_audio_pin *pin,
1586                                   bool enable)
1587 {
1588         if (!pin)
1589                 return;
1590
1591         WREG32_AUDIO_ENDPT(pin->offset, ixAZALIA_F0_CODEC_PIN_CONTROL_HOT_PLUG_CONTROL,
1592                            enable ? AZALIA_F0_CODEC_PIN_CONTROL_HOT_PLUG_CONTROL__AUDIO_ENABLED_MASK : 0);
1593 }
1594
1595 static const u32 pin_offsets[] =
1596 {
1597         AUD0_REGISTER_OFFSET,
1598         AUD1_REGISTER_OFFSET,
1599         AUD2_REGISTER_OFFSET,
1600         AUD3_REGISTER_OFFSET,
1601         AUD4_REGISTER_OFFSET,
1602         AUD5_REGISTER_OFFSET,
1603         AUD6_REGISTER_OFFSET,
1604         AUD7_REGISTER_OFFSET,
1605 };
1606
1607 static int dce_v11_0_audio_init(struct amdgpu_device *adev)
1608 {
1609         int i;
1610
1611         if (!amdgpu_audio)
1612                 return 0;
1613
1614         adev->mode_info.audio.enabled = true;
1615
1616         switch (adev->asic_type) {
1617         case CHIP_CARRIZO:
1618         case CHIP_STONEY:
1619                 adev->mode_info.audio.num_pins = 7;
1620                 break;
1621         case CHIP_POLARIS10:
1622                 adev->mode_info.audio.num_pins = 8;
1623                 break;
1624         case CHIP_POLARIS11:
1625                 adev->mode_info.audio.num_pins = 6;
1626                 break;
1627         default:
1628                 return -EINVAL;
1629         }
1630
1631         for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
1632                 adev->mode_info.audio.pin[i].channels = -1;
1633                 adev->mode_info.audio.pin[i].rate = -1;
1634                 adev->mode_info.audio.pin[i].bits_per_sample = -1;
1635                 adev->mode_info.audio.pin[i].status_bits = 0;
1636                 adev->mode_info.audio.pin[i].category_code = 0;
1637                 adev->mode_info.audio.pin[i].connected = false;
1638                 adev->mode_info.audio.pin[i].offset = pin_offsets[i];
1639                 adev->mode_info.audio.pin[i].id = i;
1640                 /* disable audio.  it will be set up later */
1641                 /* XXX remove once we switch to ip funcs */
1642                 dce_v11_0_audio_enable(adev, &adev->mode_info.audio.pin[i], false);
1643         }
1644
1645         return 0;
1646 }
1647
1648 static void dce_v11_0_audio_fini(struct amdgpu_device *adev)
1649 {
1650         int i;
1651
1652         if (!amdgpu_audio)
1653                 return;
1654
1655         if (!adev->mode_info.audio.enabled)
1656                 return;
1657
1658         for (i = 0; i < adev->mode_info.audio.num_pins; i++)
1659                 dce_v11_0_audio_enable(adev, &adev->mode_info.audio.pin[i], false);
1660
1661         adev->mode_info.audio.enabled = false;
1662 }
1663
1664 /*
1665  * update the N and CTS parameters for a given pixel clock rate
1666  */
1667 static void dce_v11_0_afmt_update_ACR(struct drm_encoder *encoder, uint32_t clock)
1668 {
1669         struct drm_device *dev = encoder->dev;
1670         struct amdgpu_device *adev = dev->dev_private;
1671         struct amdgpu_afmt_acr acr = amdgpu_afmt_acr(clock);
1672         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1673         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1674         u32 tmp;
1675
1676         tmp = RREG32(mmHDMI_ACR_32_0 + dig->afmt->offset);
1677         tmp = REG_SET_FIELD(tmp, HDMI_ACR_32_0, HDMI_ACR_CTS_32, acr.cts_32khz);
1678         WREG32(mmHDMI_ACR_32_0 + dig->afmt->offset, tmp);
1679         tmp = RREG32(mmHDMI_ACR_32_1 + dig->afmt->offset);
1680         tmp = REG_SET_FIELD(tmp, HDMI_ACR_32_1, HDMI_ACR_N_32, acr.n_32khz);
1681         WREG32(mmHDMI_ACR_32_1 + dig->afmt->offset, tmp);
1682
1683         tmp = RREG32(mmHDMI_ACR_44_0 + dig->afmt->offset);
1684         tmp = REG_SET_FIELD(tmp, HDMI_ACR_44_0, HDMI_ACR_CTS_44, acr.cts_44_1khz);
1685         WREG32(mmHDMI_ACR_44_0 + dig->afmt->offset, tmp);
1686         tmp = RREG32(mmHDMI_ACR_44_1 + dig->afmt->offset);
1687         tmp = REG_SET_FIELD(tmp, HDMI_ACR_44_1, HDMI_ACR_N_44, acr.n_44_1khz);
1688         WREG32(mmHDMI_ACR_44_1 + dig->afmt->offset, tmp);
1689
1690         tmp = RREG32(mmHDMI_ACR_48_0 + dig->afmt->offset);
1691         tmp = REG_SET_FIELD(tmp, HDMI_ACR_48_0, HDMI_ACR_CTS_48, acr.cts_48khz);
1692         WREG32(mmHDMI_ACR_48_0 + dig->afmt->offset, tmp);
1693         tmp = RREG32(mmHDMI_ACR_48_1 + dig->afmt->offset);
1694         tmp = REG_SET_FIELD(tmp, HDMI_ACR_48_1, HDMI_ACR_N_48, acr.n_48khz);
1695         WREG32(mmHDMI_ACR_48_1 + dig->afmt->offset, tmp);
1696
1697 }
1698
1699 /*
1700  * build a HDMI Video Info Frame
1701  */
1702 static void dce_v11_0_afmt_update_avi_infoframe(struct drm_encoder *encoder,
1703                                                void *buffer, size_t size)
1704 {
1705         struct drm_device *dev = encoder->dev;
1706         struct amdgpu_device *adev = dev->dev_private;
1707         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1708         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1709         uint8_t *frame = buffer + 3;
1710         uint8_t *header = buffer;
1711
1712         WREG32(mmAFMT_AVI_INFO0 + dig->afmt->offset,
1713                 frame[0x0] | (frame[0x1] << 8) | (frame[0x2] << 16) | (frame[0x3] << 24));
1714         WREG32(mmAFMT_AVI_INFO1 + dig->afmt->offset,
1715                 frame[0x4] | (frame[0x5] << 8) | (frame[0x6] << 16) | (frame[0x7] << 24));
1716         WREG32(mmAFMT_AVI_INFO2 + dig->afmt->offset,
1717                 frame[0x8] | (frame[0x9] << 8) | (frame[0xA] << 16) | (frame[0xB] << 24));
1718         WREG32(mmAFMT_AVI_INFO3 + dig->afmt->offset,
1719                 frame[0xC] | (frame[0xD] << 8) | (header[1] << 24));
1720 }
1721
1722 static void dce_v11_0_audio_set_dto(struct drm_encoder *encoder, u32 clock)
1723 {
1724         struct drm_device *dev = encoder->dev;
1725         struct amdgpu_device *adev = dev->dev_private;
1726         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1727         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1728         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
1729         u32 dto_phase = 24 * 1000;
1730         u32 dto_modulo = clock;
1731         u32 tmp;
1732
1733         if (!dig || !dig->afmt)
1734                 return;
1735
1736         /* XXX two dtos; generally use dto0 for hdmi */
1737         /* Express [24MHz / target pixel clock] as an exact rational
1738          * number (coefficient of two integer numbers.  DCCG_AUDIO_DTOx_PHASE
1739          * is the numerator, DCCG_AUDIO_DTOx_MODULE is the denominator
1740          */
1741         tmp = RREG32(mmDCCG_AUDIO_DTO_SOURCE);
1742         tmp = REG_SET_FIELD(tmp, DCCG_AUDIO_DTO_SOURCE, DCCG_AUDIO_DTO0_SOURCE_SEL,
1743                             amdgpu_crtc->crtc_id);
1744         WREG32(mmDCCG_AUDIO_DTO_SOURCE, tmp);
1745         WREG32(mmDCCG_AUDIO_DTO0_PHASE, dto_phase);
1746         WREG32(mmDCCG_AUDIO_DTO0_MODULE, dto_modulo);
1747 }
1748
1749 /*
1750  * update the info frames with the data from the current display mode
1751  */
1752 static void dce_v11_0_afmt_setmode(struct drm_encoder *encoder,
1753                                   struct drm_display_mode *mode)
1754 {
1755         struct drm_device *dev = encoder->dev;
1756         struct amdgpu_device *adev = dev->dev_private;
1757         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1758         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1759         struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
1760         u8 buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AVI_INFOFRAME_SIZE];
1761         struct hdmi_avi_infoframe frame;
1762         ssize_t err;
1763         u32 tmp;
1764         int bpc = 8;
1765
1766         if (!dig || !dig->afmt)
1767                 return;
1768
1769         /* Silent, r600_hdmi_enable will raise WARN for us */
1770         if (!dig->afmt->enabled)
1771                 return;
1772
1773         /* hdmi deep color mode general control packets setup, if bpc > 8 */
1774         if (encoder->crtc) {
1775                 struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
1776                 bpc = amdgpu_crtc->bpc;
1777         }
1778
1779         /* disable audio prior to setting up hw */
1780         dig->afmt->pin = dce_v11_0_audio_get_pin(adev);
1781         dce_v11_0_audio_enable(adev, dig->afmt->pin, false);
1782
1783         dce_v11_0_audio_set_dto(encoder, mode->clock);
1784
1785         tmp = RREG32(mmHDMI_VBI_PACKET_CONTROL + dig->afmt->offset);
1786         tmp = REG_SET_FIELD(tmp, HDMI_VBI_PACKET_CONTROL, HDMI_NULL_SEND, 1);
1787         WREG32(mmHDMI_VBI_PACKET_CONTROL + dig->afmt->offset, tmp); /* send null packets when required */
1788
1789         WREG32(mmAFMT_AUDIO_CRC_CONTROL + dig->afmt->offset, 0x1000);
1790
1791         tmp = RREG32(mmHDMI_CONTROL + dig->afmt->offset);
1792         switch (bpc) {
1793         case 0:
1794         case 6:
1795         case 8:
1796         case 16:
1797         default:
1798                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_ENABLE, 0);
1799                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_DEPTH, 0);
1800                 DRM_DEBUG("%s: Disabling hdmi deep color for %d bpc.\n",
1801                           connector->name, bpc);
1802                 break;
1803         case 10:
1804                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_ENABLE, 1);
1805                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_DEPTH, 1);
1806                 DRM_DEBUG("%s: Enabling hdmi deep color 30 for 10 bpc.\n",
1807                           connector->name);
1808                 break;
1809         case 12:
1810                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_ENABLE, 1);
1811                 tmp = REG_SET_FIELD(tmp, HDMI_CONTROL, HDMI_DEEP_COLOR_DEPTH, 2);
1812                 DRM_DEBUG("%s: Enabling hdmi deep color 36 for 12 bpc.\n",
1813                           connector->name);
1814                 break;
1815         }
1816         WREG32(mmHDMI_CONTROL + dig->afmt->offset, tmp);
1817
1818         tmp = RREG32(mmHDMI_VBI_PACKET_CONTROL + dig->afmt->offset);
1819         tmp = REG_SET_FIELD(tmp, HDMI_VBI_PACKET_CONTROL, HDMI_NULL_SEND, 1); /* send null packets when required */
1820         tmp = REG_SET_FIELD(tmp, HDMI_VBI_PACKET_CONTROL, HDMI_GC_SEND, 1); /* send general control packets */
1821         tmp = REG_SET_FIELD(tmp, HDMI_VBI_PACKET_CONTROL, HDMI_GC_CONT, 1); /* send general control packets every frame */
1822         WREG32(mmHDMI_VBI_PACKET_CONTROL + dig->afmt->offset, tmp);
1823
1824         tmp = RREG32(mmHDMI_INFOFRAME_CONTROL0 + dig->afmt->offset);
1825         /* enable audio info frames (frames won't be set until audio is enabled) */
1826         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL0, HDMI_AUDIO_INFO_SEND, 1);
1827         /* required for audio info values to be updated */
1828         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL0, HDMI_AUDIO_INFO_CONT, 1);
1829         WREG32(mmHDMI_INFOFRAME_CONTROL0 + dig->afmt->offset, tmp);
1830
1831         tmp = RREG32(mmAFMT_INFOFRAME_CONTROL0 + dig->afmt->offset);
1832         /* required for audio info values to be updated */
1833         tmp = REG_SET_FIELD(tmp, AFMT_INFOFRAME_CONTROL0, AFMT_AUDIO_INFO_UPDATE, 1);
1834         WREG32(mmAFMT_INFOFRAME_CONTROL0 + dig->afmt->offset, tmp);
1835
1836         tmp = RREG32(mmHDMI_INFOFRAME_CONTROL1 + dig->afmt->offset);
1837         /* anything other than 0 */
1838         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL1, HDMI_AUDIO_INFO_LINE, 2);
1839         WREG32(mmHDMI_INFOFRAME_CONTROL1 + dig->afmt->offset, tmp);
1840
1841         WREG32(mmHDMI_GC + dig->afmt->offset, 0); /* unset HDMI_GC_AVMUTE */
1842
1843         tmp = RREG32(mmHDMI_AUDIO_PACKET_CONTROL + dig->afmt->offset);
1844         /* set the default audio delay */
1845         tmp = REG_SET_FIELD(tmp, HDMI_AUDIO_PACKET_CONTROL, HDMI_AUDIO_DELAY_EN, 1);
1846         /* should be suffient for all audio modes and small enough for all hblanks */
1847         tmp = REG_SET_FIELD(tmp, HDMI_AUDIO_PACKET_CONTROL, HDMI_AUDIO_PACKETS_PER_LINE, 3);
1848         WREG32(mmHDMI_AUDIO_PACKET_CONTROL + dig->afmt->offset, tmp);
1849
1850         tmp = RREG32(mmAFMT_AUDIO_PACKET_CONTROL + dig->afmt->offset);
1851         /* allow 60958 channel status fields to be updated */
1852         tmp = REG_SET_FIELD(tmp, AFMT_AUDIO_PACKET_CONTROL, AFMT_60958_CS_UPDATE, 1);
1853         WREG32(mmAFMT_AUDIO_PACKET_CONTROL + dig->afmt->offset, tmp);
1854
1855         tmp = RREG32(mmHDMI_ACR_PACKET_CONTROL + dig->afmt->offset);
1856         if (bpc > 8)
1857                 /* clear SW CTS value */
1858                 tmp = REG_SET_FIELD(tmp, HDMI_ACR_PACKET_CONTROL, HDMI_ACR_SOURCE, 0);
1859         else
1860                 /* select SW CTS value */
1861                 tmp = REG_SET_FIELD(tmp, HDMI_ACR_PACKET_CONTROL, HDMI_ACR_SOURCE, 1);
1862         /* allow hw to sent ACR packets when required */
1863         tmp = REG_SET_FIELD(tmp, HDMI_ACR_PACKET_CONTROL, HDMI_ACR_AUTO_SEND, 1);
1864         WREG32(mmHDMI_ACR_PACKET_CONTROL + dig->afmt->offset, tmp);
1865
1866         dce_v11_0_afmt_update_ACR(encoder, mode->clock);
1867
1868         tmp = RREG32(mmAFMT_60958_0 + dig->afmt->offset);
1869         tmp = REG_SET_FIELD(tmp, AFMT_60958_0, AFMT_60958_CS_CHANNEL_NUMBER_L, 1);
1870         WREG32(mmAFMT_60958_0 + dig->afmt->offset, tmp);
1871
1872         tmp = RREG32(mmAFMT_60958_1 + dig->afmt->offset);
1873         tmp = REG_SET_FIELD(tmp, AFMT_60958_1, AFMT_60958_CS_CHANNEL_NUMBER_R, 2);
1874         WREG32(mmAFMT_60958_1 + dig->afmt->offset, tmp);
1875
1876         tmp = RREG32(mmAFMT_60958_2 + dig->afmt->offset);
1877         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_2, 3);
1878         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_3, 4);
1879         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_4, 5);
1880         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_5, 6);
1881         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_6, 7);
1882         tmp = REG_SET_FIELD(tmp, AFMT_60958_2, AFMT_60958_CS_CHANNEL_NUMBER_7, 8);
1883         WREG32(mmAFMT_60958_2 + dig->afmt->offset, tmp);
1884
1885         dce_v11_0_audio_write_speaker_allocation(encoder);
1886
1887         WREG32(mmAFMT_AUDIO_PACKET_CONTROL2 + dig->afmt->offset,
1888                (0xff << AFMT_AUDIO_PACKET_CONTROL2__AFMT_AUDIO_CHANNEL_ENABLE__SHIFT));
1889
1890         dce_v11_0_afmt_audio_select_pin(encoder);
1891         dce_v11_0_audio_write_sad_regs(encoder);
1892         dce_v11_0_audio_write_latency_fields(encoder, mode);
1893
1894         err = drm_hdmi_avi_infoframe_from_display_mode(&frame, mode);
1895         if (err < 0) {
1896                 DRM_ERROR("failed to setup AVI infoframe: %zd\n", err);
1897                 return;
1898         }
1899
1900         err = hdmi_avi_infoframe_pack(&frame, buffer, sizeof(buffer));
1901         if (err < 0) {
1902                 DRM_ERROR("failed to pack AVI infoframe: %zd\n", err);
1903                 return;
1904         }
1905
1906         dce_v11_0_afmt_update_avi_infoframe(encoder, buffer, sizeof(buffer));
1907
1908         tmp = RREG32(mmHDMI_INFOFRAME_CONTROL0 + dig->afmt->offset);
1909         /* enable AVI info frames */
1910         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL0, HDMI_AVI_INFO_SEND, 1);
1911         /* required for audio info values to be updated */
1912         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL0, HDMI_AVI_INFO_CONT, 1);
1913         WREG32(mmHDMI_INFOFRAME_CONTROL0 + dig->afmt->offset, tmp);
1914
1915         tmp = RREG32(mmHDMI_INFOFRAME_CONTROL1 + dig->afmt->offset);
1916         tmp = REG_SET_FIELD(tmp, HDMI_INFOFRAME_CONTROL1, HDMI_AVI_INFO_LINE, 2);
1917         WREG32(mmHDMI_INFOFRAME_CONTROL1 + dig->afmt->offset, tmp);
1918
1919         tmp = RREG32(mmAFMT_AUDIO_PACKET_CONTROL + dig->afmt->offset);
1920         /* send audio packets */
1921         tmp = REG_SET_FIELD(tmp, AFMT_AUDIO_PACKET_CONTROL, AFMT_AUDIO_SAMPLE_SEND, 1);
1922         WREG32(mmAFMT_AUDIO_PACKET_CONTROL + dig->afmt->offset, tmp);
1923
1924         WREG32(mmAFMT_RAMP_CONTROL0 + dig->afmt->offset, 0x00FFFFFF);
1925         WREG32(mmAFMT_RAMP_CONTROL1 + dig->afmt->offset, 0x007FFFFF);
1926         WREG32(mmAFMT_RAMP_CONTROL2 + dig->afmt->offset, 0x00000001);
1927         WREG32(mmAFMT_RAMP_CONTROL3 + dig->afmt->offset, 0x00000001);
1928
1929         /* enable audio after to setting up hw */
1930         dce_v11_0_audio_enable(adev, dig->afmt->pin, true);
1931 }
1932
1933 static void dce_v11_0_afmt_enable(struct drm_encoder *encoder, bool enable)
1934 {
1935         struct drm_device *dev = encoder->dev;
1936         struct amdgpu_device *adev = dev->dev_private;
1937         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1938         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1939
1940         if (!dig || !dig->afmt)
1941                 return;
1942
1943         /* Silent, r600_hdmi_enable will raise WARN for us */
1944         if (enable && dig->afmt->enabled)
1945                 return;
1946         if (!enable && !dig->afmt->enabled)
1947                 return;
1948
1949         if (!enable && dig->afmt->pin) {
1950                 dce_v11_0_audio_enable(adev, dig->afmt->pin, false);
1951                 dig->afmt->pin = NULL;
1952         }
1953
1954         dig->afmt->enabled = enable;
1955
1956         DRM_DEBUG("%sabling AFMT interface @ 0x%04X for encoder 0x%x\n",
1957                   enable ? "En" : "Dis", dig->afmt->offset, amdgpu_encoder->encoder_id);
1958 }
1959
1960 static int dce_v11_0_afmt_init(struct amdgpu_device *adev)
1961 {
1962         int i;
1963
1964         for (i = 0; i < adev->mode_info.num_dig; i++)
1965                 adev->mode_info.afmt[i] = NULL;
1966
1967         /* DCE11 has audio blocks tied to DIG encoders */
1968         for (i = 0; i < adev->mode_info.num_dig; i++) {
1969                 adev->mode_info.afmt[i] = kzalloc(sizeof(struct amdgpu_afmt), GFP_KERNEL);
1970                 if (adev->mode_info.afmt[i]) {
1971                         adev->mode_info.afmt[i]->offset = dig_offsets[i];
1972                         adev->mode_info.afmt[i]->id = i;
1973                 } else {
1974                         int j;
1975                         for (j = 0; j < i; j++) {
1976                                 kfree(adev->mode_info.afmt[j]);
1977                                 adev->mode_info.afmt[j] = NULL;
1978                         }
1979                         return -ENOMEM;
1980                 }
1981         }
1982         return 0;
1983 }
1984
1985 static void dce_v11_0_afmt_fini(struct amdgpu_device *adev)
1986 {
1987         int i;
1988
1989         for (i = 0; i < adev->mode_info.num_dig; i++) {
1990                 kfree(adev->mode_info.afmt[i]);
1991                 adev->mode_info.afmt[i] = NULL;
1992         }
1993 }
1994
1995 static const u32 vga_control_regs[6] =
1996 {
1997         mmD1VGA_CONTROL,
1998         mmD2VGA_CONTROL,
1999         mmD3VGA_CONTROL,
2000         mmD4VGA_CONTROL,
2001         mmD5VGA_CONTROL,
2002         mmD6VGA_CONTROL,
2003 };
2004
2005 static void dce_v11_0_vga_enable(struct drm_crtc *crtc, bool enable)
2006 {
2007         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2008         struct drm_device *dev = crtc->dev;
2009         struct amdgpu_device *adev = dev->dev_private;
2010         u32 vga_control;
2011
2012         vga_control = RREG32(vga_control_regs[amdgpu_crtc->crtc_id]) & ~1;
2013         if (enable)
2014                 WREG32(vga_control_regs[amdgpu_crtc->crtc_id], vga_control | 1);
2015         else
2016                 WREG32(vga_control_regs[amdgpu_crtc->crtc_id], vga_control);
2017 }
2018
2019 static void dce_v11_0_grph_enable(struct drm_crtc *crtc, bool enable)
2020 {
2021         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2022         struct drm_device *dev = crtc->dev;
2023         struct amdgpu_device *adev = dev->dev_private;
2024
2025         if (enable)
2026                 WREG32(mmGRPH_ENABLE + amdgpu_crtc->crtc_offset, 1);
2027         else
2028                 WREG32(mmGRPH_ENABLE + amdgpu_crtc->crtc_offset, 0);
2029 }
2030
2031 static int dce_v11_0_crtc_do_set_base(struct drm_crtc *crtc,
2032                                      struct drm_framebuffer *fb,
2033                                      int x, int y, int atomic)
2034 {
2035         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2036         struct drm_device *dev = crtc->dev;
2037         struct amdgpu_device *adev = dev->dev_private;
2038         struct amdgpu_framebuffer *amdgpu_fb;
2039         struct drm_framebuffer *target_fb;
2040         struct drm_gem_object *obj;
2041         struct amdgpu_bo *rbo;
2042         uint64_t fb_location, tiling_flags;
2043         uint32_t fb_format, fb_pitch_pixels;
2044         u32 fb_swap = REG_SET_FIELD(0, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP, ENDIAN_NONE);
2045         u32 pipe_config;
2046         u32 tmp, viewport_w, viewport_h;
2047         int r;
2048         bool bypass_lut = false;
2049
2050         /* no fb bound */
2051         if (!atomic && !crtc->primary->fb) {
2052                 DRM_DEBUG_KMS("No FB bound\n");
2053                 return 0;
2054         }
2055
2056         if (atomic) {
2057                 amdgpu_fb = to_amdgpu_framebuffer(fb);
2058                 target_fb = fb;
2059         } else {
2060                 amdgpu_fb = to_amdgpu_framebuffer(crtc->primary->fb);
2061                 target_fb = crtc->primary->fb;
2062         }
2063
2064         /* If atomic, assume fb object is pinned & idle & fenced and
2065          * just update base pointers
2066          */
2067         obj = amdgpu_fb->obj;
2068         rbo = gem_to_amdgpu_bo(obj);
2069         r = amdgpu_bo_reserve(rbo, false);
2070         if (unlikely(r != 0))
2071                 return r;
2072
2073         if (atomic) {
2074                 fb_location = amdgpu_bo_gpu_offset(rbo);
2075         } else {
2076                 r = amdgpu_bo_pin(rbo, AMDGPU_GEM_DOMAIN_VRAM, &fb_location);
2077                 if (unlikely(r != 0)) {
2078                         amdgpu_bo_unreserve(rbo);
2079                         return -EINVAL;
2080                 }
2081         }
2082
2083         amdgpu_bo_get_tiling_flags(rbo, &tiling_flags);
2084         amdgpu_bo_unreserve(rbo);
2085
2086         pipe_config = AMDGPU_TILING_GET(tiling_flags, PIPE_CONFIG);
2087
2088         switch (target_fb->pixel_format) {
2089         case DRM_FORMAT_C8:
2090                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 0);
2091                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 0);
2092                 break;
2093         case DRM_FORMAT_XRGB4444:
2094         case DRM_FORMAT_ARGB4444:
2095                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 1);
2096                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 2);
2097 #ifdef __BIG_ENDIAN
2098                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2099                                         ENDIAN_8IN16);
2100 #endif
2101                 break;
2102         case DRM_FORMAT_XRGB1555:
2103         case DRM_FORMAT_ARGB1555:
2104                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 1);
2105                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 0);
2106 #ifdef __BIG_ENDIAN
2107                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2108                                         ENDIAN_8IN16);
2109 #endif
2110                 break;
2111         case DRM_FORMAT_BGRX5551:
2112         case DRM_FORMAT_BGRA5551:
2113                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 1);
2114                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 5);
2115 #ifdef __BIG_ENDIAN
2116                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2117                                         ENDIAN_8IN16);
2118 #endif
2119                 break;
2120         case DRM_FORMAT_RGB565:
2121                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 1);
2122                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 1);
2123 #ifdef __BIG_ENDIAN
2124                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2125                                         ENDIAN_8IN16);
2126 #endif
2127                 break;
2128         case DRM_FORMAT_XRGB8888:
2129         case DRM_FORMAT_ARGB8888:
2130                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 2);
2131                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 0);
2132 #ifdef __BIG_ENDIAN
2133                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2134                                         ENDIAN_8IN32);
2135 #endif
2136                 break;
2137         case DRM_FORMAT_XRGB2101010:
2138         case DRM_FORMAT_ARGB2101010:
2139                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 2);
2140                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 1);
2141 #ifdef __BIG_ENDIAN
2142                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2143                                         ENDIAN_8IN32);
2144 #endif
2145                 /* Greater 8 bpc fb needs to bypass hw-lut to retain precision */
2146                 bypass_lut = true;
2147                 break;
2148         case DRM_FORMAT_BGRX1010102:
2149         case DRM_FORMAT_BGRA1010102:
2150                 fb_format = REG_SET_FIELD(0, GRPH_CONTROL, GRPH_DEPTH, 2);
2151                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_FORMAT, 4);
2152 #ifdef __BIG_ENDIAN
2153                 fb_swap = REG_SET_FIELD(fb_swap, GRPH_SWAP_CNTL, GRPH_ENDIAN_SWAP,
2154                                         ENDIAN_8IN32);
2155 #endif
2156                 /* Greater 8 bpc fb needs to bypass hw-lut to retain precision */
2157                 bypass_lut = true;
2158                 break;
2159         default:
2160                 DRM_ERROR("Unsupported screen format %s\n",
2161                         drm_get_format_name(target_fb->pixel_format));
2162                 return -EINVAL;
2163         }
2164
2165         if (AMDGPU_TILING_GET(tiling_flags, ARRAY_MODE) == ARRAY_2D_TILED_THIN1) {
2166                 unsigned bankw, bankh, mtaspect, tile_split, num_banks;
2167
2168                 bankw = AMDGPU_TILING_GET(tiling_flags, BANK_WIDTH);
2169                 bankh = AMDGPU_TILING_GET(tiling_flags, BANK_HEIGHT);
2170                 mtaspect = AMDGPU_TILING_GET(tiling_flags, MACRO_TILE_ASPECT);
2171                 tile_split = AMDGPU_TILING_GET(tiling_flags, TILE_SPLIT);
2172                 num_banks = AMDGPU_TILING_GET(tiling_flags, NUM_BANKS);
2173
2174                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_NUM_BANKS, num_banks);
2175                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_ARRAY_MODE,
2176                                           ARRAY_2D_TILED_THIN1);
2177                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_TILE_SPLIT,
2178                                           tile_split);
2179                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_BANK_WIDTH, bankw);
2180                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_BANK_HEIGHT, bankh);
2181                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_MACRO_TILE_ASPECT,
2182                                           mtaspect);
2183                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_MICRO_TILE_MODE,
2184                                           ADDR_SURF_MICRO_TILING_DISPLAY);
2185         } else if (AMDGPU_TILING_GET(tiling_flags, ARRAY_MODE) == ARRAY_1D_TILED_THIN1) {
2186                 fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_ARRAY_MODE,
2187                                           ARRAY_1D_TILED_THIN1);
2188         }
2189
2190         fb_format = REG_SET_FIELD(fb_format, GRPH_CONTROL, GRPH_PIPE_CONFIG,
2191                                   pipe_config);
2192
2193         dce_v11_0_vga_enable(crtc, false);
2194
2195         /* Make sure surface address is updated at vertical blank rather than
2196          * horizontal blank
2197          */
2198         tmp = RREG32(mmGRPH_FLIP_CONTROL + amdgpu_crtc->crtc_offset);
2199         tmp = REG_SET_FIELD(tmp, GRPH_FLIP_CONTROL,
2200                             GRPH_SURFACE_UPDATE_H_RETRACE_EN, 0);
2201         WREG32(mmGRPH_FLIP_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2202
2203         WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS_HIGH + amdgpu_crtc->crtc_offset,
2204                upper_32_bits(fb_location));
2205         WREG32(mmGRPH_SECONDARY_SURFACE_ADDRESS_HIGH + amdgpu_crtc->crtc_offset,
2206                upper_32_bits(fb_location));
2207         WREG32(mmGRPH_PRIMARY_SURFACE_ADDRESS + amdgpu_crtc->crtc_offset,
2208                (u32)fb_location & GRPH_PRIMARY_SURFACE_ADDRESS__GRPH_PRIMARY_SURFACE_ADDRESS_MASK);
2209         WREG32(mmGRPH_SECONDARY_SURFACE_ADDRESS + amdgpu_crtc->crtc_offset,
2210                (u32) fb_location & GRPH_SECONDARY_SURFACE_ADDRESS__GRPH_SECONDARY_SURFACE_ADDRESS_MASK);
2211         WREG32(mmGRPH_CONTROL + amdgpu_crtc->crtc_offset, fb_format);
2212         WREG32(mmGRPH_SWAP_CNTL + amdgpu_crtc->crtc_offset, fb_swap);
2213
2214         /*
2215          * The LUT only has 256 slots for indexing by a 8 bpc fb. Bypass the LUT
2216          * for > 8 bpc scanout to avoid truncation of fb indices to 8 msb's, to
2217          * retain the full precision throughout the pipeline.
2218          */
2219         tmp = RREG32(mmGRPH_LUT_10BIT_BYPASS + amdgpu_crtc->crtc_offset);
2220         if (bypass_lut)
2221                 tmp = REG_SET_FIELD(tmp, GRPH_LUT_10BIT_BYPASS, GRPH_LUT_10BIT_BYPASS_EN, 1);
2222         else
2223                 tmp = REG_SET_FIELD(tmp, GRPH_LUT_10BIT_BYPASS, GRPH_LUT_10BIT_BYPASS_EN, 0);
2224         WREG32(mmGRPH_LUT_10BIT_BYPASS + amdgpu_crtc->crtc_offset, tmp);
2225
2226         if (bypass_lut)
2227                 DRM_DEBUG_KMS("Bypassing hardware LUT due to 10 bit fb scanout.\n");
2228
2229         WREG32(mmGRPH_SURFACE_OFFSET_X + amdgpu_crtc->crtc_offset, 0);
2230         WREG32(mmGRPH_SURFACE_OFFSET_Y + amdgpu_crtc->crtc_offset, 0);
2231         WREG32(mmGRPH_X_START + amdgpu_crtc->crtc_offset, 0);
2232         WREG32(mmGRPH_Y_START + amdgpu_crtc->crtc_offset, 0);
2233         WREG32(mmGRPH_X_END + amdgpu_crtc->crtc_offset, target_fb->width);
2234         WREG32(mmGRPH_Y_END + amdgpu_crtc->crtc_offset, target_fb->height);
2235
2236         fb_pitch_pixels = target_fb->pitches[0] / (target_fb->bits_per_pixel / 8);
2237         WREG32(mmGRPH_PITCH + amdgpu_crtc->crtc_offset, fb_pitch_pixels);
2238
2239         dce_v11_0_grph_enable(crtc, true);
2240
2241         WREG32(mmLB_DESKTOP_HEIGHT + amdgpu_crtc->crtc_offset,
2242                target_fb->height);
2243
2244         x &= ~3;
2245         y &= ~1;
2246         WREG32(mmVIEWPORT_START + amdgpu_crtc->crtc_offset,
2247                (x << 16) | y);
2248         viewport_w = crtc->mode.hdisplay;
2249         viewport_h = (crtc->mode.vdisplay + 1) & ~1;
2250         WREG32(mmVIEWPORT_SIZE + amdgpu_crtc->crtc_offset,
2251                (viewport_w << 16) | viewport_h);
2252
2253         /* set pageflip to happen only at start of vblank interval (front porch) */
2254         WREG32(mmCRTC_MASTER_UPDATE_MODE + amdgpu_crtc->crtc_offset, 3);
2255
2256         if (!atomic && fb && fb != crtc->primary->fb) {
2257                 amdgpu_fb = to_amdgpu_framebuffer(fb);
2258                 rbo = gem_to_amdgpu_bo(amdgpu_fb->obj);
2259                 r = amdgpu_bo_reserve(rbo, false);
2260                 if (unlikely(r != 0))
2261                         return r;
2262                 amdgpu_bo_unpin(rbo);
2263                 amdgpu_bo_unreserve(rbo);
2264         }
2265
2266         /* Bytes per pixel may have changed */
2267         dce_v11_0_bandwidth_update(adev);
2268
2269         return 0;
2270 }
2271
2272 static void dce_v11_0_set_interleave(struct drm_crtc *crtc,
2273                                      struct drm_display_mode *mode)
2274 {
2275         struct drm_device *dev = crtc->dev;
2276         struct amdgpu_device *adev = dev->dev_private;
2277         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2278         u32 tmp;
2279
2280         tmp = RREG32(mmLB_DATA_FORMAT + amdgpu_crtc->crtc_offset);
2281         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
2282                 tmp = REG_SET_FIELD(tmp, LB_DATA_FORMAT, INTERLEAVE_EN, 1);
2283         else
2284                 tmp = REG_SET_FIELD(tmp, LB_DATA_FORMAT, INTERLEAVE_EN, 0);
2285         WREG32(mmLB_DATA_FORMAT + amdgpu_crtc->crtc_offset, tmp);
2286 }
2287
2288 static void dce_v11_0_crtc_load_lut(struct drm_crtc *crtc)
2289 {
2290         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2291         struct drm_device *dev = crtc->dev;
2292         struct amdgpu_device *adev = dev->dev_private;
2293         int i;
2294         u32 tmp;
2295
2296         DRM_DEBUG_KMS("%d\n", amdgpu_crtc->crtc_id);
2297
2298         tmp = RREG32(mmINPUT_CSC_CONTROL + amdgpu_crtc->crtc_offset);
2299         tmp = REG_SET_FIELD(tmp, INPUT_CSC_CONTROL, INPUT_CSC_GRPH_MODE, 0);
2300         WREG32(mmINPUT_CSC_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2301
2302         tmp = RREG32(mmPRESCALE_GRPH_CONTROL + amdgpu_crtc->crtc_offset);
2303         tmp = REG_SET_FIELD(tmp, PRESCALE_GRPH_CONTROL, GRPH_PRESCALE_BYPASS, 1);
2304         WREG32(mmPRESCALE_GRPH_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2305
2306         tmp = RREG32(mmINPUT_GAMMA_CONTROL + amdgpu_crtc->crtc_offset);
2307         tmp = REG_SET_FIELD(tmp, INPUT_GAMMA_CONTROL, GRPH_INPUT_GAMMA_MODE, 0);
2308         WREG32(mmINPUT_GAMMA_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2309
2310         WREG32(mmDC_LUT_CONTROL + amdgpu_crtc->crtc_offset, 0);
2311
2312         WREG32(mmDC_LUT_BLACK_OFFSET_BLUE + amdgpu_crtc->crtc_offset, 0);
2313         WREG32(mmDC_LUT_BLACK_OFFSET_GREEN + amdgpu_crtc->crtc_offset, 0);
2314         WREG32(mmDC_LUT_BLACK_OFFSET_RED + amdgpu_crtc->crtc_offset, 0);
2315
2316         WREG32(mmDC_LUT_WHITE_OFFSET_BLUE + amdgpu_crtc->crtc_offset, 0xffff);
2317         WREG32(mmDC_LUT_WHITE_OFFSET_GREEN + amdgpu_crtc->crtc_offset, 0xffff);
2318         WREG32(mmDC_LUT_WHITE_OFFSET_RED + amdgpu_crtc->crtc_offset, 0xffff);
2319
2320         WREG32(mmDC_LUT_RW_MODE + amdgpu_crtc->crtc_offset, 0);
2321         WREG32(mmDC_LUT_WRITE_EN_MASK + amdgpu_crtc->crtc_offset, 0x00000007);
2322
2323         WREG32(mmDC_LUT_RW_INDEX + amdgpu_crtc->crtc_offset, 0);
2324         for (i = 0; i < 256; i++) {
2325                 WREG32(mmDC_LUT_30_COLOR + amdgpu_crtc->crtc_offset,
2326                        (amdgpu_crtc->lut_r[i] << 20) |
2327                        (amdgpu_crtc->lut_g[i] << 10) |
2328                        (amdgpu_crtc->lut_b[i] << 0));
2329         }
2330
2331         tmp = RREG32(mmDEGAMMA_CONTROL + amdgpu_crtc->crtc_offset);
2332         tmp = REG_SET_FIELD(tmp, DEGAMMA_CONTROL, GRPH_DEGAMMA_MODE, 0);
2333         tmp = REG_SET_FIELD(tmp, DEGAMMA_CONTROL, CURSOR_DEGAMMA_MODE, 0);
2334         tmp = REG_SET_FIELD(tmp, DEGAMMA_CONTROL, CURSOR2_DEGAMMA_MODE, 0);
2335         WREG32(mmDEGAMMA_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2336
2337         tmp = RREG32(mmGAMUT_REMAP_CONTROL + amdgpu_crtc->crtc_offset);
2338         tmp = REG_SET_FIELD(tmp, GAMUT_REMAP_CONTROL, GRPH_GAMUT_REMAP_MODE, 0);
2339         WREG32(mmGAMUT_REMAP_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2340
2341         tmp = RREG32(mmREGAMMA_CONTROL + amdgpu_crtc->crtc_offset);
2342         tmp = REG_SET_FIELD(tmp, REGAMMA_CONTROL, GRPH_REGAMMA_MODE, 0);
2343         WREG32(mmREGAMMA_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2344
2345         tmp = RREG32(mmOUTPUT_CSC_CONTROL + amdgpu_crtc->crtc_offset);
2346         tmp = REG_SET_FIELD(tmp, OUTPUT_CSC_CONTROL, OUTPUT_CSC_GRPH_MODE, 0);
2347         WREG32(mmOUTPUT_CSC_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2348
2349         /* XXX match this to the depth of the crtc fmt block, move to modeset? */
2350         WREG32(mmDENORM_CONTROL + amdgpu_crtc->crtc_offset, 0);
2351         /* XXX this only needs to be programmed once per crtc at startup,
2352          * not sure where the best place for it is
2353          */
2354         tmp = RREG32(mmALPHA_CONTROL + amdgpu_crtc->crtc_offset);
2355         tmp = REG_SET_FIELD(tmp, ALPHA_CONTROL, CURSOR_ALPHA_BLND_ENA, 1);
2356         WREG32(mmALPHA_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2357 }
2358
2359 static int dce_v11_0_pick_dig_encoder(struct drm_encoder *encoder)
2360 {
2361         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
2362         struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
2363
2364         switch (amdgpu_encoder->encoder_id) {
2365         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
2366                 if (dig->linkb)
2367                         return 1;
2368                 else
2369                         return 0;
2370                 break;
2371         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
2372                 if (dig->linkb)
2373                         return 3;
2374                 else
2375                         return 2;
2376                 break;
2377         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
2378                 if (dig->linkb)
2379                         return 5;
2380                 else
2381                         return 4;
2382                 break;
2383         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
2384                 return 6;
2385                 break;
2386         default:
2387                 DRM_ERROR("invalid encoder_id: 0x%x\n", amdgpu_encoder->encoder_id);
2388                 return 0;
2389         }
2390 }
2391
2392 /**
2393  * dce_v11_0_pick_pll - Allocate a PPLL for use by the crtc.
2394  *
2395  * @crtc: drm crtc
2396  *
2397  * Returns the PPLL (Pixel PLL) to be used by the crtc.  For DP monitors
2398  * a single PPLL can be used for all DP crtcs/encoders.  For non-DP
2399  * monitors a dedicated PPLL must be used.  If a particular board has
2400  * an external DP PLL, return ATOM_PPLL_INVALID to skip PLL programming
2401  * as there is no need to program the PLL itself.  If we are not able to
2402  * allocate a PLL, return ATOM_PPLL_INVALID to skip PLL programming to
2403  * avoid messing up an existing monitor.
2404  *
2405  * Asic specific PLL information
2406  *
2407  * DCE 10.x
2408  * Tonga
2409  * - PPLL1, PPLL2 are available for all UNIPHY (both DP and non-DP)
2410  * CI
2411  * - PPLL0, PPLL1, PPLL2 are available for all UNIPHY (both DP and non-DP) and DAC
2412  *
2413  */
2414 static u32 dce_v11_0_pick_pll(struct drm_crtc *crtc)
2415 {
2416         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2417         struct drm_device *dev = crtc->dev;
2418         struct amdgpu_device *adev = dev->dev_private;
2419         u32 pll_in_use;
2420         int pll;
2421
2422         if ((adev->asic_type == CHIP_POLARIS10) ||
2423             (adev->asic_type == CHIP_POLARIS11)) {
2424                 struct amdgpu_encoder *amdgpu_encoder =
2425                         to_amdgpu_encoder(amdgpu_crtc->encoder);
2426                 struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
2427
2428                 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(amdgpu_crtc->encoder)))
2429                         return ATOM_DP_DTO;
2430
2431                 switch (amdgpu_encoder->encoder_id) {
2432                 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
2433                         if (dig->linkb)
2434                                 return ATOM_COMBOPHY_PLL1;
2435                         else
2436                                 return ATOM_COMBOPHY_PLL0;
2437                         break;
2438                 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
2439                         if (dig->linkb)
2440                                 return ATOM_COMBOPHY_PLL3;
2441                         else
2442                                 return ATOM_COMBOPHY_PLL2;
2443                         break;
2444                 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
2445                         if (dig->linkb)
2446                                 return ATOM_COMBOPHY_PLL5;
2447                         else
2448                                 return ATOM_COMBOPHY_PLL4;
2449                         break;
2450                 default:
2451                         DRM_ERROR("invalid encoder_id: 0x%x\n", amdgpu_encoder->encoder_id);
2452                         return ATOM_PPLL_INVALID;
2453                 }
2454         }
2455
2456         if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(amdgpu_crtc->encoder))) {
2457                 if (adev->clock.dp_extclk)
2458                         /* skip PPLL programming if using ext clock */
2459                         return ATOM_PPLL_INVALID;
2460                 else {
2461                         /* use the same PPLL for all DP monitors */
2462                         pll = amdgpu_pll_get_shared_dp_ppll(crtc);
2463                         if (pll != ATOM_PPLL_INVALID)
2464                                 return pll;
2465                 }
2466         } else {
2467                 /* use the same PPLL for all monitors with the same clock */
2468                 pll = amdgpu_pll_get_shared_nondp_ppll(crtc);
2469                 if (pll != ATOM_PPLL_INVALID)
2470                         return pll;
2471         }
2472
2473         /* XXX need to determine what plls are available on each DCE11 part */
2474         pll_in_use = amdgpu_pll_get_use_mask(crtc);
2475         if (adev->asic_type == CHIP_CARRIZO || adev->asic_type == CHIP_STONEY) {
2476                 if (!(pll_in_use & (1 << ATOM_PPLL1)))
2477                         return ATOM_PPLL1;
2478                 if (!(pll_in_use & (1 << ATOM_PPLL0)))
2479                         return ATOM_PPLL0;
2480                 DRM_ERROR("unable to allocate a PPLL\n");
2481                 return ATOM_PPLL_INVALID;
2482         } else {
2483                 if (!(pll_in_use & (1 << ATOM_PPLL2)))
2484                         return ATOM_PPLL2;
2485                 if (!(pll_in_use & (1 << ATOM_PPLL1)))
2486                         return ATOM_PPLL1;
2487                 if (!(pll_in_use & (1 << ATOM_PPLL0)))
2488                         return ATOM_PPLL0;
2489                 DRM_ERROR("unable to allocate a PPLL\n");
2490                 return ATOM_PPLL_INVALID;
2491         }
2492         return ATOM_PPLL_INVALID;
2493 }
2494
2495 static void dce_v11_0_lock_cursor(struct drm_crtc *crtc, bool lock)
2496 {
2497         struct amdgpu_device *adev = crtc->dev->dev_private;
2498         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2499         uint32_t cur_lock;
2500
2501         cur_lock = RREG32(mmCUR_UPDATE + amdgpu_crtc->crtc_offset);
2502         if (lock)
2503                 cur_lock = REG_SET_FIELD(cur_lock, CUR_UPDATE, CURSOR_UPDATE_LOCK, 1);
2504         else
2505                 cur_lock = REG_SET_FIELD(cur_lock, CUR_UPDATE, CURSOR_UPDATE_LOCK, 0);
2506         WREG32(mmCUR_UPDATE + amdgpu_crtc->crtc_offset, cur_lock);
2507 }
2508
2509 static void dce_v11_0_hide_cursor(struct drm_crtc *crtc)
2510 {
2511         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2512         struct amdgpu_device *adev = crtc->dev->dev_private;
2513         u32 tmp;
2514
2515         tmp = RREG32_IDX(mmCUR_CONTROL + amdgpu_crtc->crtc_offset);
2516         tmp = REG_SET_FIELD(tmp, CUR_CONTROL, CURSOR_EN, 0);
2517         WREG32_IDX(mmCUR_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2518 }
2519
2520 static void dce_v11_0_show_cursor(struct drm_crtc *crtc)
2521 {
2522         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2523         struct amdgpu_device *adev = crtc->dev->dev_private;
2524         u32 tmp;
2525
2526         WREG32(mmCUR_SURFACE_ADDRESS_HIGH + amdgpu_crtc->crtc_offset,
2527                upper_32_bits(amdgpu_crtc->cursor_addr));
2528         WREG32(mmCUR_SURFACE_ADDRESS + amdgpu_crtc->crtc_offset,
2529                lower_32_bits(amdgpu_crtc->cursor_addr));
2530
2531         tmp = RREG32_IDX(mmCUR_CONTROL + amdgpu_crtc->crtc_offset);
2532         tmp = REG_SET_FIELD(tmp, CUR_CONTROL, CURSOR_EN, 1);
2533         tmp = REG_SET_FIELD(tmp, CUR_CONTROL, CURSOR_MODE, 2);
2534         WREG32_IDX(mmCUR_CONTROL + amdgpu_crtc->crtc_offset, tmp);
2535 }
2536
2537 static int dce_v11_0_cursor_move_locked(struct drm_crtc *crtc,
2538                                         int x, int y)
2539 {
2540         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2541         struct amdgpu_device *adev = crtc->dev->dev_private;
2542         int xorigin = 0, yorigin = 0;
2543
2544         /* avivo cursor are offset into the total surface */
2545         x += crtc->x;
2546         y += crtc->y;
2547         DRM_DEBUG("x %d y %d c->x %d c->y %d\n", x, y, crtc->x, crtc->y);
2548
2549         if (x < 0) {
2550                 xorigin = min(-x, amdgpu_crtc->max_cursor_width - 1);
2551                 x = 0;
2552         }
2553         if (y < 0) {
2554                 yorigin = min(-y, amdgpu_crtc->max_cursor_height - 1);
2555                 y = 0;
2556         }
2557
2558         WREG32(mmCUR_POSITION + amdgpu_crtc->crtc_offset, (x << 16) | y);
2559         WREG32(mmCUR_HOT_SPOT + amdgpu_crtc->crtc_offset, (xorigin << 16) | yorigin);
2560         WREG32(mmCUR_SIZE + amdgpu_crtc->crtc_offset,
2561                ((amdgpu_crtc->cursor_width - 1) << 16) | (amdgpu_crtc->cursor_height - 1));
2562
2563         amdgpu_crtc->cursor_x = x;
2564         amdgpu_crtc->cursor_y = y;
2565
2566         return 0;
2567 }
2568
2569 static int dce_v11_0_crtc_cursor_move(struct drm_crtc *crtc,
2570                                       int x, int y)
2571 {
2572         int ret;
2573
2574         dce_v11_0_lock_cursor(crtc, true);
2575         ret = dce_v11_0_cursor_move_locked(crtc, x, y);
2576         dce_v11_0_lock_cursor(crtc, false);
2577
2578         return ret;
2579 }
2580
2581 static int dce_v11_0_crtc_cursor_set2(struct drm_crtc *crtc,
2582                                       struct drm_file *file_priv,
2583                                       uint32_t handle,
2584                                       uint32_t width,
2585                                       uint32_t height,
2586                                       int32_t hot_x,
2587                                       int32_t hot_y)
2588 {
2589         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2590         struct drm_gem_object *obj;
2591         struct amdgpu_bo *aobj;
2592         int ret;
2593
2594         if (!handle) {
2595                 /* turn off cursor */
2596                 dce_v11_0_hide_cursor(crtc);
2597                 obj = NULL;
2598                 goto unpin;
2599         }
2600
2601         if ((width > amdgpu_crtc->max_cursor_width) ||
2602             (height > amdgpu_crtc->max_cursor_height)) {
2603                 DRM_ERROR("bad cursor width or height %d x %d\n", width, height);
2604                 return -EINVAL;
2605         }
2606
2607         obj = drm_gem_object_lookup(file_priv, handle);
2608         if (!obj) {
2609                 DRM_ERROR("Cannot find cursor object %x for crtc %d\n", handle, amdgpu_crtc->crtc_id);
2610                 return -ENOENT;
2611         }
2612
2613         aobj = gem_to_amdgpu_bo(obj);
2614         ret = amdgpu_bo_reserve(aobj, false);
2615         if (ret != 0) {
2616                 drm_gem_object_unreference_unlocked(obj);
2617                 return ret;
2618         }
2619
2620         ret = amdgpu_bo_pin(aobj, AMDGPU_GEM_DOMAIN_VRAM, &amdgpu_crtc->cursor_addr);
2621         amdgpu_bo_unreserve(aobj);
2622         if (ret) {
2623                 DRM_ERROR("Failed to pin new cursor BO (%d)\n", ret);
2624                 drm_gem_object_unreference_unlocked(obj);
2625                 return ret;
2626         }
2627
2628         amdgpu_crtc->cursor_width = width;
2629         amdgpu_crtc->cursor_height = height;
2630
2631         dce_v11_0_lock_cursor(crtc, true);
2632
2633         if (hot_x != amdgpu_crtc->cursor_hot_x ||
2634             hot_y != amdgpu_crtc->cursor_hot_y) {
2635                 int x, y;
2636
2637                 x = amdgpu_crtc->cursor_x + amdgpu_crtc->cursor_hot_x - hot_x;
2638                 y = amdgpu_crtc->cursor_y + amdgpu_crtc->cursor_hot_y - hot_y;
2639
2640                 dce_v11_0_cursor_move_locked(crtc, x, y);
2641
2642                 amdgpu_crtc->cursor_hot_x = hot_x;
2643                 amdgpu_crtc->cursor_hot_y = hot_y;
2644         }
2645
2646         dce_v11_0_show_cursor(crtc);
2647         dce_v11_0_lock_cursor(crtc, false);
2648
2649 unpin:
2650         if (amdgpu_crtc->cursor_bo) {
2651                 struct amdgpu_bo *aobj = gem_to_amdgpu_bo(amdgpu_crtc->cursor_bo);
2652                 ret = amdgpu_bo_reserve(aobj, false);
2653                 if (likely(ret == 0)) {
2654                         amdgpu_bo_unpin(aobj);
2655                         amdgpu_bo_unreserve(aobj);
2656                 }
2657                 drm_gem_object_unreference_unlocked(amdgpu_crtc->cursor_bo);
2658         }
2659
2660         amdgpu_crtc->cursor_bo = obj;
2661         return 0;
2662 }
2663
2664 static void dce_v11_0_cursor_reset(struct drm_crtc *crtc)
2665 {
2666         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2667
2668         if (amdgpu_crtc->cursor_bo) {
2669                 dce_v11_0_lock_cursor(crtc, true);
2670
2671                 dce_v11_0_cursor_move_locked(crtc, amdgpu_crtc->cursor_x,
2672                                              amdgpu_crtc->cursor_y);
2673
2674                 dce_v11_0_show_cursor(crtc);
2675
2676                 dce_v11_0_lock_cursor(crtc, false);
2677         }
2678 }
2679
2680 static int dce_v11_0_crtc_gamma_set(struct drm_crtc *crtc, u16 *red, u16 *green,
2681                                     u16 *blue, uint32_t size)
2682 {
2683         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2684         int i;
2685
2686         /* userspace palettes are always correct as is */
2687         for (i = 0; i < size; i++) {
2688                 amdgpu_crtc->lut_r[i] = red[i] >> 6;
2689                 amdgpu_crtc->lut_g[i] = green[i] >> 6;
2690                 amdgpu_crtc->lut_b[i] = blue[i] >> 6;
2691         }
2692         dce_v11_0_crtc_load_lut(crtc);
2693
2694         return 0;
2695 }
2696
2697 static void dce_v11_0_crtc_destroy(struct drm_crtc *crtc)
2698 {
2699         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2700
2701         drm_crtc_cleanup(crtc);
2702         kfree(amdgpu_crtc);
2703 }
2704
2705 static const struct drm_crtc_funcs dce_v11_0_crtc_funcs = {
2706         .cursor_set2 = dce_v11_0_crtc_cursor_set2,
2707         .cursor_move = dce_v11_0_crtc_cursor_move,
2708         .gamma_set = dce_v11_0_crtc_gamma_set,
2709         .set_config = amdgpu_crtc_set_config,
2710         .destroy = dce_v11_0_crtc_destroy,
2711         .page_flip = amdgpu_crtc_page_flip,
2712 };
2713
2714 static void dce_v11_0_crtc_dpms(struct drm_crtc *crtc, int mode)
2715 {
2716         struct drm_device *dev = crtc->dev;
2717         struct amdgpu_device *adev = dev->dev_private;
2718         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2719         unsigned type;
2720
2721         switch (mode) {
2722         case DRM_MODE_DPMS_ON:
2723                 amdgpu_crtc->enabled = true;
2724                 amdgpu_atombios_crtc_enable(crtc, ATOM_ENABLE);
2725                 dce_v11_0_vga_enable(crtc, true);
2726                 amdgpu_atombios_crtc_blank(crtc, ATOM_DISABLE);
2727                 dce_v11_0_vga_enable(crtc, false);
2728                 /* Make sure VBLANK and PFLIP interrupts are still enabled */
2729                 type = amdgpu_crtc_idx_to_irq_type(adev, amdgpu_crtc->crtc_id);
2730                 amdgpu_irq_update(adev, &adev->crtc_irq, type);
2731                 amdgpu_irq_update(adev, &adev->pageflip_irq, type);
2732                 drm_crtc_vblank_on(crtc);
2733                 dce_v11_0_crtc_load_lut(crtc);
2734                 break;
2735         case DRM_MODE_DPMS_STANDBY:
2736         case DRM_MODE_DPMS_SUSPEND:
2737         case DRM_MODE_DPMS_OFF:
2738                 drm_crtc_vblank_off(crtc);
2739                 if (amdgpu_crtc->enabled) {
2740                         dce_v11_0_vga_enable(crtc, true);
2741                         amdgpu_atombios_crtc_blank(crtc, ATOM_ENABLE);
2742                         dce_v11_0_vga_enable(crtc, false);
2743                 }
2744                 amdgpu_atombios_crtc_enable(crtc, ATOM_DISABLE);
2745                 amdgpu_crtc->enabled = false;
2746                 break;
2747         }
2748         /* adjust pm to dpms */
2749         amdgpu_pm_compute_clocks(adev);
2750 }
2751
2752 static void dce_v11_0_crtc_prepare(struct drm_crtc *crtc)
2753 {
2754         /* disable crtc pair power gating before programming */
2755         amdgpu_atombios_crtc_powergate(crtc, ATOM_DISABLE);
2756         amdgpu_atombios_crtc_lock(crtc, ATOM_ENABLE);
2757         dce_v11_0_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
2758 }
2759
2760 static void dce_v11_0_crtc_commit(struct drm_crtc *crtc)
2761 {
2762         dce_v11_0_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
2763         amdgpu_atombios_crtc_lock(crtc, ATOM_DISABLE);
2764 }
2765
2766 static void dce_v11_0_crtc_disable(struct drm_crtc *crtc)
2767 {
2768         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2769         struct drm_device *dev = crtc->dev;
2770         struct amdgpu_device *adev = dev->dev_private;
2771         struct amdgpu_atom_ss ss;
2772         int i;
2773
2774         dce_v11_0_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
2775         if (crtc->primary->fb) {
2776                 int r;
2777                 struct amdgpu_framebuffer *amdgpu_fb;
2778                 struct amdgpu_bo *rbo;
2779
2780                 amdgpu_fb = to_amdgpu_framebuffer(crtc->primary->fb);
2781                 rbo = gem_to_amdgpu_bo(amdgpu_fb->obj);
2782                 r = amdgpu_bo_reserve(rbo, false);
2783                 if (unlikely(r))
2784                         DRM_ERROR("failed to reserve rbo before unpin\n");
2785                 else {
2786                         amdgpu_bo_unpin(rbo);
2787                         amdgpu_bo_unreserve(rbo);
2788                 }
2789         }
2790         /* disable the GRPH */
2791         dce_v11_0_grph_enable(crtc, false);
2792
2793         amdgpu_atombios_crtc_powergate(crtc, ATOM_ENABLE);
2794
2795         for (i = 0; i < adev->mode_info.num_crtc; i++) {
2796                 if (adev->mode_info.crtcs[i] &&
2797                     adev->mode_info.crtcs[i]->enabled &&
2798                     i != amdgpu_crtc->crtc_id &&
2799                     amdgpu_crtc->pll_id == adev->mode_info.crtcs[i]->pll_id) {
2800                         /* one other crtc is using this pll don't turn
2801                          * off the pll
2802                          */
2803                         goto done;
2804                 }
2805         }
2806
2807         switch (amdgpu_crtc->pll_id) {
2808         case ATOM_PPLL0:
2809         case ATOM_PPLL1:
2810         case ATOM_PPLL2:
2811                 /* disable the ppll */
2812                 amdgpu_atombios_crtc_program_pll(crtc, amdgpu_crtc->crtc_id, amdgpu_crtc->pll_id,
2813                                                  0, 0, ATOM_DISABLE, 0, 0, 0, 0, 0, false, &ss);
2814                 break;
2815         case ATOM_COMBOPHY_PLL0:
2816         case ATOM_COMBOPHY_PLL1:
2817         case ATOM_COMBOPHY_PLL2:
2818         case ATOM_COMBOPHY_PLL3:
2819         case ATOM_COMBOPHY_PLL4:
2820         case ATOM_COMBOPHY_PLL5:
2821                 /* disable the ppll */
2822                 amdgpu_atombios_crtc_program_pll(crtc, ATOM_CRTC_INVALID, amdgpu_crtc->pll_id,
2823                                                  0, 0, ATOM_DISABLE, 0, 0, 0, 0, 0, false, &ss);
2824                 break;
2825         default:
2826                 break;
2827         }
2828 done:
2829         amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
2830         amdgpu_crtc->adjusted_clock = 0;
2831         amdgpu_crtc->encoder = NULL;
2832         amdgpu_crtc->connector = NULL;
2833 }
2834
2835 static int dce_v11_0_crtc_mode_set(struct drm_crtc *crtc,
2836                                   struct drm_display_mode *mode,
2837                                   struct drm_display_mode *adjusted_mode,
2838                                   int x, int y, struct drm_framebuffer *old_fb)
2839 {
2840         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2841         struct drm_device *dev = crtc->dev;
2842         struct amdgpu_device *adev = dev->dev_private;
2843
2844         if (!amdgpu_crtc->adjusted_clock)
2845                 return -EINVAL;
2846
2847         if ((adev->asic_type == CHIP_POLARIS10) ||
2848             (adev->asic_type == CHIP_POLARIS11)) {
2849                 struct amdgpu_encoder *amdgpu_encoder =
2850                         to_amdgpu_encoder(amdgpu_crtc->encoder);
2851                 int encoder_mode =
2852                         amdgpu_atombios_encoder_get_encoder_mode(amdgpu_crtc->encoder);
2853
2854                 /* SetPixelClock calculates the plls and ss values now */
2855                 amdgpu_atombios_crtc_program_pll(crtc, amdgpu_crtc->crtc_id,
2856                                                  amdgpu_crtc->pll_id,
2857                                                  encoder_mode, amdgpu_encoder->encoder_id,
2858                                                  adjusted_mode->clock, 0, 0, 0, 0,
2859                                                  amdgpu_crtc->bpc, amdgpu_crtc->ss_enabled, &amdgpu_crtc->ss);
2860         } else {
2861                 amdgpu_atombios_crtc_set_pll(crtc, adjusted_mode);
2862         }
2863         amdgpu_atombios_crtc_set_dtd_timing(crtc, adjusted_mode);
2864         dce_v11_0_crtc_do_set_base(crtc, old_fb, x, y, 0);
2865         amdgpu_atombios_crtc_overscan_setup(crtc, mode, adjusted_mode);
2866         amdgpu_atombios_crtc_scaler_setup(crtc);
2867         dce_v11_0_cursor_reset(crtc);
2868         /* update the hw version fpr dpm */
2869         amdgpu_crtc->hw_mode = *adjusted_mode;
2870
2871         return 0;
2872 }
2873
2874 static bool dce_v11_0_crtc_mode_fixup(struct drm_crtc *crtc,
2875                                      const struct drm_display_mode *mode,
2876                                      struct drm_display_mode *adjusted_mode)
2877 {
2878         struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
2879         struct drm_device *dev = crtc->dev;
2880         struct drm_encoder *encoder;
2881
2882         /* assign the encoder to the amdgpu crtc to avoid repeated lookups later */
2883         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
2884                 if (encoder->crtc == crtc) {
2885                         amdgpu_crtc->encoder = encoder;
2886                         amdgpu_crtc->connector = amdgpu_get_connector_for_encoder(encoder);
2887                         break;
2888                 }
2889         }
2890         if ((amdgpu_crtc->encoder == NULL) || (amdgpu_crtc->connector == NULL)) {
2891                 amdgpu_crtc->encoder = NULL;
2892                 amdgpu_crtc->connector = NULL;
2893                 return false;
2894         }
2895         if (!amdgpu_crtc_scaling_mode_fixup(crtc, mode, adjusted_mode))
2896                 return false;
2897         if (amdgpu_atombios_crtc_prepare_pll(crtc, adjusted_mode))
2898                 return false;
2899         /* pick pll */
2900         amdgpu_crtc->pll_id = dce_v11_0_pick_pll(crtc);
2901         /* if we can't get a PPLL for a non-DP encoder, fail */
2902         if ((amdgpu_crtc->pll_id == ATOM_PPLL_INVALID) &&
2903             !ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(amdgpu_crtc->encoder)))
2904                 return false;
2905
2906         return true;
2907 }
2908
2909 static int dce_v11_0_crtc_set_base(struct drm_crtc *crtc, int x, int y,
2910                                   struct drm_framebuffer *old_fb)
2911 {
2912         return dce_v11_0_crtc_do_set_base(crtc, old_fb, x, y, 0);
2913 }
2914
2915 static int dce_v11_0_crtc_set_base_atomic(struct drm_crtc *crtc,
2916                                          struct drm_framebuffer *fb,
2917                                          int x, int y, enum mode_set_atomic state)
2918 {
2919        return dce_v11_0_crtc_do_set_base(crtc, fb, x, y, 1);
2920 }
2921
2922 static const struct drm_crtc_helper_funcs dce_v11_0_crtc_helper_funcs = {
2923         .dpms = dce_v11_0_crtc_dpms,
2924         .mode_fixup = dce_v11_0_crtc_mode_fixup,
2925         .mode_set = dce_v11_0_crtc_mode_set,
2926         .mode_set_base = dce_v11_0_crtc_set_base,
2927         .mode_set_base_atomic = dce_v11_0_crtc_set_base_atomic,
2928         .prepare = dce_v11_0_crtc_prepare,
2929         .commit = dce_v11_0_crtc_commit,
2930         .load_lut = dce_v11_0_crtc_load_lut,
2931         .disable = dce_v11_0_crtc_disable,
2932 };
2933
2934 static int dce_v11_0_crtc_init(struct amdgpu_device *adev, int index)
2935 {
2936         struct amdgpu_crtc *amdgpu_crtc;
2937         int i;
2938
2939         amdgpu_crtc = kzalloc(sizeof(struct amdgpu_crtc) +
2940                               (AMDGPUFB_CONN_LIMIT * sizeof(struct drm_connector *)), GFP_KERNEL);
2941         if (amdgpu_crtc == NULL)
2942                 return -ENOMEM;
2943
2944         drm_crtc_init(adev->ddev, &amdgpu_crtc->base, &dce_v11_0_crtc_funcs);
2945
2946         drm_mode_crtc_set_gamma_size(&amdgpu_crtc->base, 256);
2947         amdgpu_crtc->crtc_id = index;
2948         adev->mode_info.crtcs[index] = amdgpu_crtc;
2949
2950         amdgpu_crtc->max_cursor_width = 128;
2951         amdgpu_crtc->max_cursor_height = 128;
2952         adev->ddev->mode_config.cursor_width = amdgpu_crtc->max_cursor_width;
2953         adev->ddev->mode_config.cursor_height = amdgpu_crtc->max_cursor_height;
2954
2955         for (i = 0; i < 256; i++) {
2956                 amdgpu_crtc->lut_r[i] = i << 2;
2957                 amdgpu_crtc->lut_g[i] = i << 2;
2958                 amdgpu_crtc->lut_b[i] = i << 2;
2959         }
2960
2961         switch (amdgpu_crtc->crtc_id) {
2962         case 0:
2963         default:
2964                 amdgpu_crtc->crtc_offset = CRTC0_REGISTER_OFFSET;
2965                 break;
2966         case 1:
2967                 amdgpu_crtc->crtc_offset = CRTC1_REGISTER_OFFSET;
2968                 break;
2969         case 2:
2970                 amdgpu_crtc->crtc_offset = CRTC2_REGISTER_OFFSET;
2971                 break;
2972         case 3:
2973                 amdgpu_crtc->crtc_offset = CRTC3_REGISTER_OFFSET;
2974                 break;
2975         case 4:
2976                 amdgpu_crtc->crtc_offset = CRTC4_REGISTER_OFFSET;
2977                 break;
2978         case 5:
2979                 amdgpu_crtc->crtc_offset = CRTC5_REGISTER_OFFSET;
2980                 break;
2981         }
2982
2983         amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
2984         amdgpu_crtc->adjusted_clock = 0;
2985         amdgpu_crtc->encoder = NULL;
2986         amdgpu_crtc->connector = NULL;
2987         drm_crtc_helper_add(&amdgpu_crtc->base, &dce_v11_0_crtc_helper_funcs);
2988
2989         return 0;
2990 }
2991
2992 static int dce_v11_0_early_init(void *handle)
2993 {
2994         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2995
2996         adev->audio_endpt_rreg = &dce_v11_0_audio_endpt_rreg;
2997         adev->audio_endpt_wreg = &dce_v11_0_audio_endpt_wreg;
2998
2999         dce_v11_0_set_display_funcs(adev);
3000         dce_v11_0_set_irq_funcs(adev);
3001
3002         switch (adev->asic_type) {
3003         case CHIP_CARRIZO:
3004                 adev->mode_info.num_crtc = 3;
3005                 adev->mode_info.num_hpd = 6;
3006                 adev->mode_info.num_dig = 9;
3007                 break;
3008         case CHIP_STONEY:
3009                 adev->mode_info.num_crtc = 2;
3010                 adev->mode_info.num_hpd = 6;
3011                 adev->mode_info.num_dig = 9;
3012                 break;
3013         case CHIP_POLARIS10:
3014                 adev->mode_info.num_crtc = 6;
3015                 adev->mode_info.num_hpd = 6;
3016                 adev->mode_info.num_dig = 6;
3017                 break;
3018         case CHIP_POLARIS11:
3019                 adev->mode_info.num_crtc = 5;
3020                 adev->mode_info.num_hpd = 5;
3021                 adev->mode_info.num_dig = 5;
3022                 break;
3023         default:
3024                 /* FIXME: not supported yet */
3025                 return -EINVAL;
3026         }
3027
3028         return 0;
3029 }
3030
3031 static int dce_v11_0_sw_init(void *handle)
3032 {
3033         int r, i;
3034         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3035
3036         for (i = 0; i < adev->mode_info.num_crtc; i++) {
3037                 r = amdgpu_irq_add_id(adev, i + 1, &adev->crtc_irq);
3038                 if (r)
3039                         return r;
3040         }
3041
3042         for (i = 8; i < 20; i += 2) {
3043                 r = amdgpu_irq_add_id(adev, i, &adev->pageflip_irq);
3044                 if (r)
3045                         return r;
3046         }
3047
3048         /* HPD hotplug */
3049         r = amdgpu_irq_add_id(adev, 42, &adev->hpd_irq);
3050         if (r)
3051                 return r;
3052
3053         adev->ddev->mode_config.funcs = &amdgpu_mode_funcs;
3054
3055         adev->ddev->mode_config.async_page_flip = true;
3056
3057         adev->ddev->mode_config.max_width = 16384;
3058         adev->ddev->mode_config.max_height = 16384;
3059
3060         adev->ddev->mode_config.preferred_depth = 24;
3061         adev->ddev->mode_config.prefer_shadow = 1;
3062
3063         adev->ddev->mode_config.fb_base = adev->mc.aper_base;
3064
3065         r = amdgpu_modeset_create_props(adev);
3066         if (r)
3067                 return r;
3068
3069         adev->ddev->mode_config.max_width = 16384;
3070         adev->ddev->mode_config.max_height = 16384;
3071
3072
3073         /* allocate crtcs */
3074         for (i = 0; i < adev->mode_info.num_crtc; i++) {
3075                 r = dce_v11_0_crtc_init(adev, i);
3076                 if (r)
3077                         return r;
3078         }
3079
3080         if (amdgpu_atombios_get_connector_info_from_object_table(adev))
3081                 amdgpu_print_display_setup(adev->ddev);
3082         else
3083                 return -EINVAL;
3084
3085         /* setup afmt */
3086         r = dce_v11_0_afmt_init(adev);
3087         if (r)
3088                 return r;
3089
3090         r = dce_v11_0_audio_init(adev);
3091         if (r)
3092                 return r;
3093
3094         drm_kms_helper_poll_init(adev->ddev);
3095
3096         adev->mode_info.mode_config_initialized = true;
3097         return 0;
3098 }
3099
3100 static int dce_v11_0_sw_fini(void *handle)
3101 {
3102         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3103
3104         kfree(adev->mode_info.bios_hardcoded_edid);
3105
3106         drm_kms_helper_poll_fini(adev->ddev);
3107
3108         dce_v11_0_audio_fini(adev);
3109
3110         dce_v11_0_afmt_fini(adev);
3111
3112         adev->mode_info.mode_config_initialized = false;
3113
3114         return 0;
3115 }
3116
3117 static int dce_v11_0_hw_init(void *handle)
3118 {
3119         int i;
3120         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3121
3122         dce_v11_0_init_golden_registers(adev);
3123
3124         /* init dig PHYs, disp eng pll */
3125         amdgpu_atombios_crtc_powergate_init(adev);
3126         amdgpu_atombios_encoder_init_dig(adev);
3127         if ((adev->asic_type == CHIP_POLARIS10) ||
3128             (adev->asic_type == CHIP_POLARIS11)) {
3129                 amdgpu_atombios_crtc_set_dce_clock(adev, adev->clock.default_dispclk,
3130                                                    DCE_CLOCK_TYPE_DISPCLK, ATOM_GCK_DFS);
3131                 amdgpu_atombios_crtc_set_dce_clock(adev, 0,
3132                                                    DCE_CLOCK_TYPE_DPREFCLK, ATOM_GCK_DFS);
3133         } else {
3134                 amdgpu_atombios_crtc_set_disp_eng_pll(adev, adev->clock.default_dispclk);
3135         }
3136
3137         /* initialize hpd */
3138         dce_v11_0_hpd_init(adev);
3139
3140         for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
3141                 dce_v11_0_audio_enable(adev, &adev->mode_info.audio.pin[i], false);
3142         }
3143
3144         dce_v11_0_pageflip_interrupt_init(adev);
3145
3146         return 0;
3147 }
3148
3149 static int dce_v11_0_hw_fini(void *handle)
3150 {
3151         int i;
3152         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3153
3154         dce_v11_0_hpd_fini(adev);
3155
3156         for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
3157                 dce_v11_0_audio_enable(adev, &adev->mode_info.audio.pin[i], false);
3158         }
3159
3160         dce_v11_0_pageflip_interrupt_fini(adev);
3161
3162         return 0;
3163 }
3164
3165 static int dce_v11_0_suspend(void *handle)
3166 {
3167         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3168
3169         amdgpu_atombios_scratch_regs_save(adev);
3170
3171         return dce_v11_0_hw_fini(handle);
3172 }
3173
3174 static int dce_v11_0_resume(void *handle)
3175 {
3176         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3177         int ret;
3178
3179         ret = dce_v11_0_hw_init(handle);
3180
3181         amdgpu_atombios_scratch_regs_restore(adev);
3182
3183         /* turn on the BL */
3184         if (adev->mode_info.bl_encoder) {
3185                 u8 bl_level = amdgpu_display_backlight_get_level(adev,
3186                                                                   adev->mode_info.bl_encoder);
3187                 amdgpu_display_backlight_set_level(adev, adev->mode_info.bl_encoder,
3188                                                     bl_level);
3189         }
3190
3191         return ret;
3192 }
3193
3194 static bool dce_v11_0_is_idle(void *handle)
3195 {
3196         return true;
3197 }
3198
3199 static int dce_v11_0_wait_for_idle(void *handle)
3200 {
3201         return 0;
3202 }
3203
3204 static int dce_v11_0_soft_reset(void *handle)
3205 {
3206         u32 srbm_soft_reset = 0, tmp;
3207         struct amdgpu_device *adev = (struct amdgpu_device *)handle;
3208
3209         if (dce_v11_0_is_display_hung(adev))
3210                 srbm_soft_reset |= SRBM_SOFT_RESET__SOFT_RESET_DC_MASK;
3211
3212         if (srbm_soft_reset) {
3213                 tmp = RREG32(mmSRBM_SOFT_RESET);
3214                 tmp |= srbm_soft_reset;
3215                 dev_info(adev->dev, "SRBM_SOFT_RESET=0x%08X\n", tmp);
3216                 WREG32(mmSRBM_SOFT_RESET, tmp);
3217                 tmp = RREG32(mmSRBM_SOFT_RESET);
3218
3219                 udelay(50);
3220
3221                 tmp &= ~srbm_soft_reset;
3222                 WREG32(mmSRBM_SOFT_RESET, tmp);
3223                 tmp = RREG32(mmSRBM_SOFT_RESET);
3224
3225                 /* Wait a little for things to settle down */
3226                 udelay(50);
3227         }
3228         return 0;
3229 }
3230
3231 static void dce_v11_0_set_crtc_vblank_interrupt_state(struct amdgpu_device *adev,
3232                                                      int crtc,
3233                                                      enum amdgpu_interrupt_state state)
3234 {
3235         u32 lb_interrupt_mask;
3236
3237         if (crtc >= adev->mode_info.num_crtc) {
3238                 DRM_DEBUG("invalid crtc %d\n", crtc);
3239                 return;
3240         }
3241
3242         switch (state) {
3243         case AMDGPU_IRQ_STATE_DISABLE:
3244                 lb_interrupt_mask = RREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc]);
3245                 lb_interrupt_mask = REG_SET_FIELD(lb_interrupt_mask, LB_INTERRUPT_MASK,
3246                                                   VBLANK_INTERRUPT_MASK, 0);
3247                 WREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc], lb_interrupt_mask);
3248                 break;
3249         case AMDGPU_IRQ_STATE_ENABLE:
3250                 lb_interrupt_mask = RREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc]);
3251                 lb_interrupt_mask = REG_SET_FIELD(lb_interrupt_mask, LB_INTERRUPT_MASK,
3252                                                   VBLANK_INTERRUPT_MASK, 1);
3253                 WREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc], lb_interrupt_mask);
3254                 break;
3255         default:
3256                 break;
3257         }
3258 }
3259
3260 static void dce_v11_0_set_crtc_vline_interrupt_state(struct amdgpu_device *adev,
3261                                                     int crtc,
3262                                                     enum amdgpu_interrupt_state state)
3263 {
3264         u32 lb_interrupt_mask;
3265
3266         if (crtc >= adev->mode_info.num_crtc) {
3267                 DRM_DEBUG("invalid crtc %d\n", crtc);
3268                 return;
3269         }
3270
3271         switch (state) {
3272         case AMDGPU_IRQ_STATE_DISABLE:
3273                 lb_interrupt_mask = RREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc]);
3274                 lb_interrupt_mask = REG_SET_FIELD(lb_interrupt_mask, LB_INTERRUPT_MASK,
3275                                                   VLINE_INTERRUPT_MASK, 0);
3276                 WREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc], lb_interrupt_mask);
3277                 break;
3278         case AMDGPU_IRQ_STATE_ENABLE:
3279                 lb_interrupt_mask = RREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc]);
3280                 lb_interrupt_mask = REG_SET_FIELD(lb_interrupt_mask, LB_INTERRUPT_MASK,
3281                                                   VLINE_INTERRUPT_MASK, 1);
3282                 WREG32(mmLB_INTERRUPT_MASK + crtc_offsets[crtc], lb_interrupt_mask);
3283                 break;
3284         default:
3285                 break;
3286         }
3287 }
3288
3289 static int dce_v11_0_set_hpd_irq_state(struct amdgpu_device *adev,
3290                                         struct amdgpu_irq_src *source,
3291                                         unsigned hpd,
3292                                         enum amdgpu_interrupt_state state)
3293 {
3294         u32 tmp;
3295
3296         if (hpd >= adev->mode_info.num_hpd) {
3297                 DRM_DEBUG("invalid hdp %d\n", hpd);
3298                 return 0;
3299         }
3300
3301         switch (state) {
3302         case AMDGPU_IRQ_STATE_DISABLE:
3303                 tmp = RREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd]);
3304                 tmp = REG_SET_FIELD(tmp, DC_HPD_INT_CONTROL, DC_HPD_INT_EN, 0);
3305                 WREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd], tmp);
3306                 break;
3307         case AMDGPU_IRQ_STATE_ENABLE:
3308                 tmp = RREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd]);
3309                 tmp = REG_SET_FIELD(tmp, DC_HPD_INT_CONTROL, DC_HPD_INT_EN, 1);
3310                 WREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd], tmp);
3311                 break;
3312         default:
3313                 break;
3314         }
3315
3316         return 0;
3317 }
3318
3319 static int dce_v11_0_set_crtc_irq_state(struct amdgpu_device *adev,
3320                                         struct amdgpu_irq_src *source,
3321                                         unsigned type,
3322                                         enum amdgpu_interrupt_state state)
3323 {
3324         switch (type) {
3325         case AMDGPU_CRTC_IRQ_VBLANK1:
3326                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 0, state);
3327                 break;
3328         case AMDGPU_CRTC_IRQ_VBLANK2:
3329                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 1, state);
3330                 break;
3331         case AMDGPU_CRTC_IRQ_VBLANK3:
3332                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 2, state);
3333                 break;
3334         case AMDGPU_CRTC_IRQ_VBLANK4:
3335                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 3, state);
3336                 break;
3337         case AMDGPU_CRTC_IRQ_VBLANK5:
3338                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 4, state);
3339                 break;
3340         case AMDGPU_CRTC_IRQ_VBLANK6:
3341                 dce_v11_0_set_crtc_vblank_interrupt_state(adev, 5, state);
3342                 break;
3343         case AMDGPU_CRTC_IRQ_VLINE1:
3344                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 0, state);
3345                 break;
3346         case AMDGPU_CRTC_IRQ_VLINE2:
3347                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 1, state);
3348                 break;
3349         case AMDGPU_CRTC_IRQ_VLINE3:
3350                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 2, state);
3351                 break;
3352         case AMDGPU_CRTC_IRQ_VLINE4:
3353                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 3, state);
3354                 break;
3355         case AMDGPU_CRTC_IRQ_VLINE5:
3356                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 4, state);
3357                 break;
3358          case AMDGPU_CRTC_IRQ_VLINE6:
3359                 dce_v11_0_set_crtc_vline_interrupt_state(adev, 5, state);
3360                 break;
3361         default:
3362                 break;
3363         }
3364         return 0;
3365 }
3366
3367 static int dce_v11_0_set_pageflip_irq_state(struct amdgpu_device *adev,
3368                                             struct amdgpu_irq_src *src,
3369                                             unsigned type,
3370                                             enum amdgpu_interrupt_state state)
3371 {
3372         u32 reg;
3373
3374         if (type >= adev->mode_info.num_crtc) {
3375                 DRM_ERROR("invalid pageflip crtc %d\n", type);
3376                 return -EINVAL;
3377         }
3378
3379         reg = RREG32(mmGRPH_INTERRUPT_CONTROL + crtc_offsets[type]);
3380         if (state == AMDGPU_IRQ_STATE_DISABLE)
3381                 WREG32(mmGRPH_INTERRUPT_CONTROL + crtc_offsets[type],
3382                        reg & ~GRPH_INTERRUPT_CONTROL__GRPH_PFLIP_INT_MASK_MASK);
3383         else
3384                 WREG32(mmGRPH_INTERRUPT_CONTROL + crtc_offsets[type],
3385                        reg | GRPH_INTERRUPT_CONTROL__GRPH_PFLIP_INT_MASK_MASK);
3386
3387         return 0;
3388 }
3389
3390 static int dce_v11_0_pageflip_irq(struct amdgpu_device *adev,
3391                                   struct amdgpu_irq_src *source,
3392                                   struct amdgpu_iv_entry *entry)
3393 {
3394         unsigned long flags;
3395         unsigned crtc_id;
3396         struct amdgpu_crtc *amdgpu_crtc;
3397         struct amdgpu_flip_work *works;
3398
3399         crtc_id = (entry->src_id - 8) >> 1;
3400         amdgpu_crtc = adev->mode_info.crtcs[crtc_id];
3401
3402         if (crtc_id >= adev->mode_info.num_crtc) {
3403                 DRM_ERROR("invalid pageflip crtc %d\n", crtc_id);
3404                 return -EINVAL;
3405         }
3406
3407         if (RREG32(mmGRPH_INTERRUPT_STATUS + crtc_offsets[crtc_id]) &
3408             GRPH_INTERRUPT_STATUS__GRPH_PFLIP_INT_OCCURRED_MASK)
3409                 WREG32(mmGRPH_INTERRUPT_STATUS + crtc_offsets[crtc_id],
3410                        GRPH_INTERRUPT_STATUS__GRPH_PFLIP_INT_CLEAR_MASK);
3411
3412         /* IRQ could occur when in initial stage */
3413         if(amdgpu_crtc == NULL)
3414                 return 0;
3415
3416         spin_lock_irqsave(&adev->ddev->event_lock, flags);
3417         works = amdgpu_crtc->pflip_works;
3418         if (amdgpu_crtc->pflip_status != AMDGPU_FLIP_SUBMITTED){
3419                 DRM_DEBUG_DRIVER("amdgpu_crtc->pflip_status = %d != "
3420                                                  "AMDGPU_FLIP_SUBMITTED(%d)\n",
3421                                                  amdgpu_crtc->pflip_status,
3422                                                  AMDGPU_FLIP_SUBMITTED);
3423                 spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
3424                 return 0;
3425         }
3426
3427         /* page flip completed. clean up */
3428         amdgpu_crtc->pflip_status = AMDGPU_FLIP_NONE;
3429         amdgpu_crtc->pflip_works = NULL;
3430
3431         /* wakeup usersapce */
3432         if(works->event)
3433                 drm_crtc_send_vblank_event(&amdgpu_crtc->base, works->event);
3434
3435         spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
3436
3437         drm_crtc_vblank_put(&amdgpu_crtc->base);
3438         schedule_work(&works->unpin_work);
3439
3440         return 0;
3441 }
3442
3443 static void dce_v11_0_hpd_int_ack(struct amdgpu_device *adev,
3444                                   int hpd)
3445 {
3446         u32 tmp;
3447
3448         if (hpd >= adev->mode_info.num_hpd) {
3449                 DRM_DEBUG("invalid hdp %d\n", hpd);
3450                 return;
3451         }
3452
3453         tmp = RREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd]);
3454         tmp = REG_SET_FIELD(tmp, DC_HPD_INT_CONTROL, DC_HPD_INT_ACK, 1);
3455         WREG32(mmDC_HPD_INT_CONTROL + hpd_offsets[hpd], tmp);
3456 }
3457
3458 static void dce_v11_0_crtc_vblank_int_ack(struct amdgpu_device *adev,
3459                                           int crtc)
3460 {
3461         u32 tmp;
3462
3463         if (crtc < 0 || crtc >= adev->mode_info.num_crtc) {
3464                 DRM_DEBUG("invalid crtc %d\n", crtc);
3465                 return;
3466         }
3467
3468         tmp = RREG32(mmLB_VBLANK_STATUS + crtc_offsets[crtc]);
3469         tmp = REG_SET_FIELD(tmp, LB_VBLANK_STATUS, VBLANK_ACK, 1);
3470         WREG32(mmLB_VBLANK_STATUS + crtc_offsets[crtc], tmp);
3471 }
3472
3473 static void dce_v11_0_crtc_vline_int_ack(struct amdgpu_device *adev,
3474                                          int crtc)
3475 {
3476         u32 tmp;
3477
3478         if (crtc < 0 || crtc >= adev->mode_info.num_crtc) {
3479                 DRM_DEBUG("invalid crtc %d\n", crtc);
3480                 return;
3481         }
3482
3483         tmp = RREG32(mmLB_VLINE_STATUS + crtc_offsets[crtc]);
3484         tmp = REG_SET_FIELD(tmp, LB_VLINE_STATUS, VLINE_ACK, 1);
3485         WREG32(mmLB_VLINE_STATUS + crtc_offsets[crtc], tmp);
3486 }
3487
3488 static int dce_v11_0_crtc_irq(struct amdgpu_device *adev,
3489                                 struct amdgpu_irq_src *source,
3490                                 struct amdgpu_iv_entry *entry)
3491 {
3492         unsigned crtc = entry->src_id - 1;
3493         uint32_t disp_int = RREG32(interrupt_status_offsets[crtc].reg);
3494         unsigned irq_type = amdgpu_crtc_idx_to_irq_type(adev, crtc);
3495
3496         switch (entry->src_data) {
3497         case 0: /* vblank */
3498                 if (disp_int & interrupt_status_offsets[crtc].vblank)
3499                         dce_v11_0_crtc_vblank_int_ack(adev, crtc);
3500                 else
3501                         DRM_DEBUG("IH: IH event w/o asserted irq bit?\n");
3502
3503                 if (amdgpu_irq_enabled(adev, source, irq_type)) {
3504                         drm_handle_vblank(adev->ddev, crtc);
3505                 }
3506                 DRM_DEBUG("IH: D%d vblank\n", crtc + 1);
3507
3508                 break;
3509         case 1: /* vline */
3510                 if (disp_int & interrupt_status_offsets[crtc].vline)
3511                         dce_v11_0_crtc_vline_int_ack(adev, crtc);
3512                 else
3513                         DRM_DEBUG("IH: IH event w/o asserted irq bit?\n");
3514
3515                 DRM_DEBUG("IH: D%d vline\n", crtc + 1);
3516
3517                 break;
3518         default:
3519                 DRM_DEBUG("Unhandled interrupt: %d %d\n", entry->src_id, entry->src_data);
3520                 break;
3521         }
3522
3523         return 0;
3524 }
3525
3526 static int dce_v11_0_hpd_irq(struct amdgpu_device *adev,
3527                              struct amdgpu_irq_src *source,
3528                              struct amdgpu_iv_entry *entry)
3529 {
3530         uint32_t disp_int, mask;
3531         unsigned hpd;
3532
3533         if (entry->src_data >= adev->mode_info.num_hpd) {
3534                 DRM_DEBUG("Unhandled interrupt: %d %d\n", entry->src_id, entry->src_data);
3535                 return 0;
3536         }
3537
3538         hpd = entry->src_data;
3539         disp_int = RREG32(interrupt_status_offsets[hpd].reg);
3540         mask = interrupt_status_offsets[hpd].hpd;
3541
3542         if (disp_int & mask) {
3543                 dce_v11_0_hpd_int_ack(adev, hpd);
3544                 schedule_work(&adev->hotplug_work);
3545                 DRM_DEBUG("IH: HPD%d\n", hpd + 1);
3546         }
3547
3548         return 0;
3549 }
3550
3551 static int dce_v11_0_set_clockgating_state(void *handle,
3552                                           enum amd_clockgating_state state)
3553 {
3554         return 0;
3555 }
3556
3557 static int dce_v11_0_set_powergating_state(void *handle,
3558                                           enum amd_powergating_state state)
3559 {
3560         return 0;
3561 }
3562
3563 const struct amd_ip_funcs dce_v11_0_ip_funcs = {
3564         .name = "dce_v11_0",
3565         .early_init = dce_v11_0_early_init,
3566         .late_init = NULL,
3567         .sw_init = dce_v11_0_sw_init,
3568         .sw_fini = dce_v11_0_sw_fini,
3569         .hw_init = dce_v11_0_hw_init,
3570         .hw_fini = dce_v11_0_hw_fini,
3571         .suspend = dce_v11_0_suspend,
3572         .resume = dce_v11_0_resume,
3573         .is_idle = dce_v11_0_is_idle,
3574         .wait_for_idle = dce_v11_0_wait_for_idle,
3575         .soft_reset = dce_v11_0_soft_reset,
3576         .set_clockgating_state = dce_v11_0_set_clockgating_state,
3577         .set_powergating_state = dce_v11_0_set_powergating_state,
3578 };
3579
3580 static void
3581 dce_v11_0_encoder_mode_set(struct drm_encoder *encoder,
3582                           struct drm_display_mode *mode,
3583                           struct drm_display_mode *adjusted_mode)
3584 {
3585         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
3586
3587         amdgpu_encoder->pixel_clock = adjusted_mode->clock;
3588
3589         /* need to call this here rather than in prepare() since we need some crtc info */
3590         amdgpu_atombios_encoder_dpms(encoder, DRM_MODE_DPMS_OFF);
3591
3592         /* set scaler clears this on some chips */
3593         dce_v11_0_set_interleave(encoder->crtc, mode);
3594
3595         if (amdgpu_atombios_encoder_get_encoder_mode(encoder) == ATOM_ENCODER_MODE_HDMI) {
3596                 dce_v11_0_afmt_enable(encoder, true);
3597                 dce_v11_0_afmt_setmode(encoder, adjusted_mode);
3598         }
3599 }
3600
3601 static void dce_v11_0_encoder_prepare(struct drm_encoder *encoder)
3602 {
3603         struct amdgpu_device *adev = encoder->dev->dev_private;
3604         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
3605         struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
3606
3607         if ((amdgpu_encoder->active_device &
3608              (ATOM_DEVICE_DFP_SUPPORT | ATOM_DEVICE_LCD_SUPPORT)) ||
3609             (amdgpu_encoder_get_dp_bridge_encoder_id(encoder) !=
3610              ENCODER_OBJECT_ID_NONE)) {
3611                 struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
3612                 if (dig) {
3613                         dig->dig_encoder = dce_v11_0_pick_dig_encoder(encoder);
3614                         if (amdgpu_encoder->active_device & ATOM_DEVICE_DFP_SUPPORT)
3615                                 dig->afmt = adev->mode_info.afmt[dig->dig_encoder];
3616                 }
3617         }
3618
3619         amdgpu_atombios_scratch_regs_lock(adev, true);
3620
3621         if (connector) {
3622                 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
3623
3624                 /* select the clock/data port if it uses a router */
3625                 if (amdgpu_connector->router.cd_valid)
3626                         amdgpu_i2c_router_select_cd_port(amdgpu_connector);
3627
3628                 /* turn eDP panel on for mode set */
3629                 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP)
3630                         amdgpu_atombios_encoder_set_edp_panel_power(connector,
3631                                                              ATOM_TRANSMITTER_ACTION_POWER_ON);
3632         }
3633
3634         /* this is needed for the pll/ss setup to work correctly in some cases */
3635         amdgpu_atombios_encoder_set_crtc_source(encoder);
3636         /* set up the FMT blocks */
3637         dce_v11_0_program_fmt(encoder);
3638 }
3639
3640 static void dce_v11_0_encoder_commit(struct drm_encoder *encoder)
3641 {
3642         struct drm_device *dev = encoder->dev;
3643         struct amdgpu_device *adev = dev->dev_private;
3644
3645         /* need to call this here as we need the crtc set up */
3646         amdgpu_atombios_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
3647         amdgpu_atombios_scratch_regs_lock(adev, false);
3648 }
3649
3650 static void dce_v11_0_encoder_disable(struct drm_encoder *encoder)
3651 {
3652         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
3653         struct amdgpu_encoder_atom_dig *dig;
3654
3655         amdgpu_atombios_encoder_dpms(encoder, DRM_MODE_DPMS_OFF);
3656
3657         if (amdgpu_atombios_encoder_is_digital(encoder)) {
3658                 if (amdgpu_atombios_encoder_get_encoder_mode(encoder) == ATOM_ENCODER_MODE_HDMI)
3659                         dce_v11_0_afmt_enable(encoder, false);
3660                 dig = amdgpu_encoder->enc_priv;
3661                 dig->dig_encoder = -1;
3662         }
3663         amdgpu_encoder->active_device = 0;
3664 }
3665
3666 /* these are handled by the primary encoders */
3667 static void dce_v11_0_ext_prepare(struct drm_encoder *encoder)
3668 {
3669
3670 }
3671
3672 static void dce_v11_0_ext_commit(struct drm_encoder *encoder)
3673 {
3674
3675 }
3676
3677 static void
3678 dce_v11_0_ext_mode_set(struct drm_encoder *encoder,
3679                       struct drm_display_mode *mode,
3680                       struct drm_display_mode *adjusted_mode)
3681 {
3682
3683 }
3684
3685 static void dce_v11_0_ext_disable(struct drm_encoder *encoder)
3686 {
3687
3688 }
3689
3690 static void
3691 dce_v11_0_ext_dpms(struct drm_encoder *encoder, int mode)
3692 {
3693
3694 }
3695
3696 static const struct drm_encoder_helper_funcs dce_v11_0_ext_helper_funcs = {
3697         .dpms = dce_v11_0_ext_dpms,
3698         .prepare = dce_v11_0_ext_prepare,
3699         .mode_set = dce_v11_0_ext_mode_set,
3700         .commit = dce_v11_0_ext_commit,
3701         .disable = dce_v11_0_ext_disable,
3702         /* no detect for TMDS/LVDS yet */
3703 };
3704
3705 static const struct drm_encoder_helper_funcs dce_v11_0_dig_helper_funcs = {
3706         .dpms = amdgpu_atombios_encoder_dpms,
3707         .mode_fixup = amdgpu_atombios_encoder_mode_fixup,
3708         .prepare = dce_v11_0_encoder_prepare,
3709         .mode_set = dce_v11_0_encoder_mode_set,
3710         .commit = dce_v11_0_encoder_commit,
3711         .disable = dce_v11_0_encoder_disable,
3712         .detect = amdgpu_atombios_encoder_dig_detect,
3713 };
3714
3715 static const struct drm_encoder_helper_funcs dce_v11_0_dac_helper_funcs = {
3716         .dpms = amdgpu_atombios_encoder_dpms,
3717         .mode_fixup = amdgpu_atombios_encoder_mode_fixup,
3718         .prepare = dce_v11_0_encoder_prepare,
3719         .mode_set = dce_v11_0_encoder_mode_set,
3720         .commit = dce_v11_0_encoder_commit,
3721         .detect = amdgpu_atombios_encoder_dac_detect,
3722 };
3723
3724 static void dce_v11_0_encoder_destroy(struct drm_encoder *encoder)
3725 {
3726         struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
3727         if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT))
3728                 amdgpu_atombios_encoder_fini_backlight(amdgpu_encoder);
3729         kfree(amdgpu_encoder->enc_priv);
3730         drm_encoder_cleanup(encoder);
3731         kfree(amdgpu_encoder);
3732 }
3733
3734 static const struct drm_encoder_funcs dce_v11_0_encoder_funcs = {
3735         .destroy = dce_v11_0_encoder_destroy,
3736 };
3737
3738 static void dce_v11_0_encoder_add(struct amdgpu_device *adev,
3739                                  uint32_t encoder_enum,
3740                                  uint32_t supported_device,
3741                                  u16 caps)
3742 {
3743         struct drm_device *dev = adev->ddev;
3744         struct drm_encoder *encoder;
3745         struct amdgpu_encoder *amdgpu_encoder;
3746
3747         /* see if we already added it */
3748         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
3749                 amdgpu_encoder = to_amdgpu_encoder(encoder);
3750                 if (amdgpu_encoder->encoder_enum == encoder_enum) {
3751                         amdgpu_encoder->devices |= supported_device;
3752                         return;
3753                 }
3754
3755         }
3756
3757         /* add a new one */
3758         amdgpu_encoder = kzalloc(sizeof(struct amdgpu_encoder), GFP_KERNEL);
3759         if (!amdgpu_encoder)
3760                 return;
3761
3762         encoder = &amdgpu_encoder->base;
3763         switch (adev->mode_info.num_crtc) {
3764         case 1:
3765                 encoder->possible_crtcs = 0x1;
3766                 break;
3767         case 2:
3768         default:
3769                 encoder->possible_crtcs = 0x3;
3770                 break;
3771         case 4:
3772                 encoder->possible_crtcs = 0xf;
3773                 break;
3774         case 6:
3775                 encoder->possible_crtcs = 0x3f;
3776                 break;
3777         }
3778
3779         amdgpu_encoder->enc_priv = NULL;
3780
3781         amdgpu_encoder->encoder_enum = encoder_enum;
3782         amdgpu_encoder->encoder_id = (encoder_enum & OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
3783         amdgpu_encoder->devices = supported_device;
3784         amdgpu_encoder->rmx_type = RMX_OFF;
3785         amdgpu_encoder->underscan_type = UNDERSCAN_OFF;
3786         amdgpu_encoder->is_ext_encoder = false;
3787         amdgpu_encoder->caps = caps;
3788
3789         switch (amdgpu_encoder->encoder_id) {
3790         case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
3791         case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2:
3792                 drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3793                                  DRM_MODE_ENCODER_DAC, NULL);
3794                 drm_encoder_helper_add(encoder, &dce_v11_0_dac_helper_funcs);
3795                 break;
3796         case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
3797         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
3798         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
3799         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
3800         case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
3801                 if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) {
3802                         amdgpu_encoder->rmx_type = RMX_FULL;
3803                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3804                                          DRM_MODE_ENCODER_LVDS, NULL);
3805                         amdgpu_encoder->enc_priv = amdgpu_atombios_encoder_get_lcd_info(amdgpu_encoder);
3806                 } else if (amdgpu_encoder->devices & (ATOM_DEVICE_CRT_SUPPORT)) {
3807                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3808                                          DRM_MODE_ENCODER_DAC, NULL);
3809                         amdgpu_encoder->enc_priv = amdgpu_atombios_encoder_get_dig_info(amdgpu_encoder);
3810                 } else {
3811                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3812                                          DRM_MODE_ENCODER_TMDS, NULL);
3813                         amdgpu_encoder->enc_priv = amdgpu_atombios_encoder_get_dig_info(amdgpu_encoder);
3814                 }
3815                 drm_encoder_helper_add(encoder, &dce_v11_0_dig_helper_funcs);
3816                 break;
3817         case ENCODER_OBJECT_ID_SI170B:
3818         case ENCODER_OBJECT_ID_CH7303:
3819         case ENCODER_OBJECT_ID_EXTERNAL_SDVOA:
3820         case ENCODER_OBJECT_ID_EXTERNAL_SDVOB:
3821         case ENCODER_OBJECT_ID_TITFP513:
3822         case ENCODER_OBJECT_ID_VT1623:
3823         case ENCODER_OBJECT_ID_HDMI_SI1930:
3824         case ENCODER_OBJECT_ID_TRAVIS:
3825         case ENCODER_OBJECT_ID_NUTMEG:
3826                 /* these are handled by the primary encoders */
3827                 amdgpu_encoder->is_ext_encoder = true;
3828                 if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT))
3829                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3830                                          DRM_MODE_ENCODER_LVDS, NULL);
3831                 else if (amdgpu_encoder->devices & (ATOM_DEVICE_CRT_SUPPORT))
3832                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3833                                          DRM_MODE_ENCODER_DAC, NULL);
3834                 else
3835                         drm_encoder_init(dev, encoder, &dce_v11_0_encoder_funcs,
3836                                          DRM_MODE_ENCODER_TMDS, NULL);
3837                 drm_encoder_helper_add(encoder, &dce_v11_0_ext_helper_funcs);
3838                 break;
3839         }
3840 }
3841
3842 static const struct amdgpu_display_funcs dce_v11_0_display_funcs = {
3843         .set_vga_render_state = &dce_v11_0_set_vga_render_state,
3844         .bandwidth_update = &dce_v11_0_bandwidth_update,
3845         .vblank_get_counter = &dce_v11_0_vblank_get_counter,
3846         .vblank_wait = &dce_v11_0_vblank_wait,
3847         .is_display_hung = &dce_v11_0_is_display_hung,
3848         .backlight_set_level = &amdgpu_atombios_encoder_set_backlight_level,
3849         .backlight_get_level = &amdgpu_atombios_encoder_get_backlight_level,
3850         .hpd_sense = &dce_v11_0_hpd_sense,
3851         .hpd_set_polarity = &dce_v11_0_hpd_set_polarity,
3852         .hpd_get_gpio_reg = &dce_v11_0_hpd_get_gpio_reg,
3853         .page_flip = &dce_v11_0_page_flip,
3854         .page_flip_get_scanoutpos = &dce_v11_0_crtc_get_scanoutpos,
3855         .add_encoder = &dce_v11_0_encoder_add,
3856         .add_connector = &amdgpu_connector_add,
3857         .stop_mc_access = &dce_v11_0_stop_mc_access,
3858         .resume_mc_access = &dce_v11_0_resume_mc_access,
3859 };
3860
3861 static void dce_v11_0_set_display_funcs(struct amdgpu_device *adev)
3862 {
3863         if (adev->mode_info.funcs == NULL)
3864                 adev->mode_info.funcs = &dce_v11_0_display_funcs;
3865 }
3866
3867 static const struct amdgpu_irq_src_funcs dce_v11_0_crtc_irq_funcs = {
3868         .set = dce_v11_0_set_crtc_irq_state,
3869         .process = dce_v11_0_crtc_irq,
3870 };
3871
3872 static const struct amdgpu_irq_src_funcs dce_v11_0_pageflip_irq_funcs = {
3873         .set = dce_v11_0_set_pageflip_irq_state,
3874         .process = dce_v11_0_pageflip_irq,
3875 };
3876
3877 static const struct amdgpu_irq_src_funcs dce_v11_0_hpd_irq_funcs = {
3878         .set = dce_v11_0_set_hpd_irq_state,
3879         .process = dce_v11_0_hpd_irq,
3880 };
3881
3882 static void dce_v11_0_set_irq_funcs(struct amdgpu_device *adev)
3883 {
3884         adev->crtc_irq.num_types = AMDGPU_CRTC_IRQ_LAST;
3885         adev->crtc_irq.funcs = &dce_v11_0_crtc_irq_funcs;
3886
3887         adev->pageflip_irq.num_types = AMDGPU_PAGEFLIP_IRQ_LAST;
3888         adev->pageflip_irq.funcs = &dce_v11_0_pageflip_irq_funcs;
3889
3890         adev->hpd_irq.num_types = AMDGPU_HPD_LAST;
3891         adev->hpd_irq.funcs = &dce_v11_0_hpd_irq_funcs;
3892 }