1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright © 2009 Intel Corporation
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include <linux/delay.h>
7*4882a593Smuzhiyun #include <linux/i2c.h>
8*4882a593Smuzhiyun #include <linux/pm_runtime.h>
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include <drm/drm_fourcc.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include "framebuffer.h"
13*4882a593Smuzhiyun #include "gma_display.h"
14*4882a593Smuzhiyun #include "power.h"
15*4882a593Smuzhiyun #include "psb_drv.h"
16*4882a593Smuzhiyun #include "psb_intel_drv.h"
17*4882a593Smuzhiyun #include "psb_intel_reg.h"
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #define MRST_LIMIT_LVDS_100L 0
20*4882a593Smuzhiyun #define MRST_LIMIT_LVDS_83 1
21*4882a593Smuzhiyun #define MRST_LIMIT_LVDS_100 2
22*4882a593Smuzhiyun #define MRST_LIMIT_SDVO 3
23*4882a593Smuzhiyun
24*4882a593Smuzhiyun #define MRST_DOT_MIN 19750
25*4882a593Smuzhiyun #define MRST_DOT_MAX 120000
26*4882a593Smuzhiyun #define MRST_M_MIN_100L 20
27*4882a593Smuzhiyun #define MRST_M_MIN_100 10
28*4882a593Smuzhiyun #define MRST_M_MIN_83 12
29*4882a593Smuzhiyun #define MRST_M_MAX_100L 34
30*4882a593Smuzhiyun #define MRST_M_MAX_100 17
31*4882a593Smuzhiyun #define MRST_M_MAX_83 20
32*4882a593Smuzhiyun #define MRST_P1_MIN 2
33*4882a593Smuzhiyun #define MRST_P1_MAX_0 7
34*4882a593Smuzhiyun #define MRST_P1_MAX_1 8
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun static bool mrst_lvds_find_best_pll(const struct gma_limit_t *limit,
37*4882a593Smuzhiyun struct drm_crtc *crtc, int target,
38*4882a593Smuzhiyun int refclk, struct gma_clock_t *best_clock);
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun static bool mrst_sdvo_find_best_pll(const struct gma_limit_t *limit,
41*4882a593Smuzhiyun struct drm_crtc *crtc, int target,
42*4882a593Smuzhiyun int refclk, struct gma_clock_t *best_clock);
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun static const struct gma_limit_t mrst_limits[] = {
45*4882a593Smuzhiyun { /* MRST_LIMIT_LVDS_100L */
46*4882a593Smuzhiyun .dot = {.min = MRST_DOT_MIN, .max = MRST_DOT_MAX},
47*4882a593Smuzhiyun .m = {.min = MRST_M_MIN_100L, .max = MRST_M_MAX_100L},
48*4882a593Smuzhiyun .p1 = {.min = MRST_P1_MIN, .max = MRST_P1_MAX_1},
49*4882a593Smuzhiyun .find_pll = mrst_lvds_find_best_pll,
50*4882a593Smuzhiyun },
51*4882a593Smuzhiyun { /* MRST_LIMIT_LVDS_83L */
52*4882a593Smuzhiyun .dot = {.min = MRST_DOT_MIN, .max = MRST_DOT_MAX},
53*4882a593Smuzhiyun .m = {.min = MRST_M_MIN_83, .max = MRST_M_MAX_83},
54*4882a593Smuzhiyun .p1 = {.min = MRST_P1_MIN, .max = MRST_P1_MAX_0},
55*4882a593Smuzhiyun .find_pll = mrst_lvds_find_best_pll,
56*4882a593Smuzhiyun },
57*4882a593Smuzhiyun { /* MRST_LIMIT_LVDS_100 */
58*4882a593Smuzhiyun .dot = {.min = MRST_DOT_MIN, .max = MRST_DOT_MAX},
59*4882a593Smuzhiyun .m = {.min = MRST_M_MIN_100, .max = MRST_M_MAX_100},
60*4882a593Smuzhiyun .p1 = {.min = MRST_P1_MIN, .max = MRST_P1_MAX_1},
61*4882a593Smuzhiyun .find_pll = mrst_lvds_find_best_pll,
62*4882a593Smuzhiyun },
63*4882a593Smuzhiyun { /* MRST_LIMIT_SDVO */
64*4882a593Smuzhiyun .vco = {.min = 1400000, .max = 2800000},
65*4882a593Smuzhiyun .n = {.min = 3, .max = 7},
66*4882a593Smuzhiyun .m = {.min = 80, .max = 137},
67*4882a593Smuzhiyun .p1 = {.min = 1, .max = 2},
68*4882a593Smuzhiyun .p2 = {.dot_limit = 200000, .p2_slow = 10, .p2_fast = 10},
69*4882a593Smuzhiyun .find_pll = mrst_sdvo_find_best_pll,
70*4882a593Smuzhiyun },
71*4882a593Smuzhiyun };
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun #define MRST_M_MIN 10
74*4882a593Smuzhiyun static const u32 oaktrail_m_converts[] = {
75*4882a593Smuzhiyun 0x2B, 0x15, 0x2A, 0x35, 0x1A, 0x0D, 0x26, 0x33, 0x19, 0x2C,
76*4882a593Smuzhiyun 0x36, 0x3B, 0x1D, 0x2E, 0x37, 0x1B, 0x2D, 0x16, 0x0B, 0x25,
77*4882a593Smuzhiyun 0x12, 0x09, 0x24, 0x32, 0x39, 0x1c,
78*4882a593Smuzhiyun };
79*4882a593Smuzhiyun
mrst_limit(struct drm_crtc * crtc,int refclk)80*4882a593Smuzhiyun static const struct gma_limit_t *mrst_limit(struct drm_crtc *crtc,
81*4882a593Smuzhiyun int refclk)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun const struct gma_limit_t *limit = NULL;
84*4882a593Smuzhiyun struct drm_device *dev = crtc->dev;
85*4882a593Smuzhiyun struct drm_psb_private *dev_priv = dev->dev_private;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun if (gma_pipe_has_type(crtc, INTEL_OUTPUT_LVDS)
88*4882a593Smuzhiyun || gma_pipe_has_type(crtc, INTEL_OUTPUT_MIPI)) {
89*4882a593Smuzhiyun switch (dev_priv->core_freq) {
90*4882a593Smuzhiyun case 100:
91*4882a593Smuzhiyun limit = &mrst_limits[MRST_LIMIT_LVDS_100L];
92*4882a593Smuzhiyun break;
93*4882a593Smuzhiyun case 166:
94*4882a593Smuzhiyun limit = &mrst_limits[MRST_LIMIT_LVDS_83];
95*4882a593Smuzhiyun break;
96*4882a593Smuzhiyun case 200:
97*4882a593Smuzhiyun limit = &mrst_limits[MRST_LIMIT_LVDS_100];
98*4882a593Smuzhiyun break;
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun } else if (gma_pipe_has_type(crtc, INTEL_OUTPUT_SDVO)) {
101*4882a593Smuzhiyun limit = &mrst_limits[MRST_LIMIT_SDVO];
102*4882a593Smuzhiyun } else {
103*4882a593Smuzhiyun limit = NULL;
104*4882a593Smuzhiyun dev_err(dev->dev, "mrst_limit Wrong display type.\n");
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun return limit;
108*4882a593Smuzhiyun }
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun /** Derive the pixel clock for the given refclk and divisors for 8xx chips. */
mrst_lvds_clock(int refclk,struct gma_clock_t * clock)111*4882a593Smuzhiyun static void mrst_lvds_clock(int refclk, struct gma_clock_t *clock)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun clock->dot = (refclk * clock->m) / (14 * clock->p1);
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun
mrst_print_pll(struct gma_clock_t * clock)116*4882a593Smuzhiyun static void mrst_print_pll(struct gma_clock_t *clock)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun DRM_DEBUG_DRIVER("dotclock=%d, m=%d, m1=%d, m2=%d, n=%d, p1=%d, p2=%d\n",
119*4882a593Smuzhiyun clock->dot, clock->m, clock->m1, clock->m2, clock->n,
120*4882a593Smuzhiyun clock->p1, clock->p2);
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun
mrst_sdvo_find_best_pll(const struct gma_limit_t * limit,struct drm_crtc * crtc,int target,int refclk,struct gma_clock_t * best_clock)123*4882a593Smuzhiyun static bool mrst_sdvo_find_best_pll(const struct gma_limit_t *limit,
124*4882a593Smuzhiyun struct drm_crtc *crtc, int target,
125*4882a593Smuzhiyun int refclk, struct gma_clock_t *best_clock)
126*4882a593Smuzhiyun {
127*4882a593Smuzhiyun struct gma_clock_t clock;
128*4882a593Smuzhiyun u32 target_vco, actual_freq;
129*4882a593Smuzhiyun s32 freq_error, min_error = 100000;
130*4882a593Smuzhiyun
131*4882a593Smuzhiyun memset(best_clock, 0, sizeof(*best_clock));
132*4882a593Smuzhiyun memset(&clock, 0, sizeof(clock));
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun for (clock.m = limit->m.min; clock.m <= limit->m.max; clock.m++) {
135*4882a593Smuzhiyun for (clock.n = limit->n.min; clock.n <= limit->n.max;
136*4882a593Smuzhiyun clock.n++) {
137*4882a593Smuzhiyun for (clock.p1 = limit->p1.min;
138*4882a593Smuzhiyun clock.p1 <= limit->p1.max; clock.p1++) {
139*4882a593Smuzhiyun /* p2 value always stored in p2_slow on SDVO */
140*4882a593Smuzhiyun clock.p = clock.p1 * limit->p2.p2_slow;
141*4882a593Smuzhiyun target_vco = target * clock.p;
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun /* VCO will increase at this point so break */
144*4882a593Smuzhiyun if (target_vco > limit->vco.max)
145*4882a593Smuzhiyun break;
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun if (target_vco < limit->vco.min)
148*4882a593Smuzhiyun continue;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun actual_freq = (refclk * clock.m) /
151*4882a593Smuzhiyun (clock.n * clock.p);
152*4882a593Smuzhiyun freq_error = 10000 -
153*4882a593Smuzhiyun ((target * 10000) / actual_freq);
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun if (freq_error < -min_error) {
156*4882a593Smuzhiyun /* freq_error will start to decrease at
157*4882a593Smuzhiyun this point so break */
158*4882a593Smuzhiyun break;
159*4882a593Smuzhiyun }
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun if (freq_error < 0)
162*4882a593Smuzhiyun freq_error = -freq_error;
163*4882a593Smuzhiyun
164*4882a593Smuzhiyun if (freq_error < min_error) {
165*4882a593Smuzhiyun min_error = freq_error;
166*4882a593Smuzhiyun *best_clock = clock;
167*4882a593Smuzhiyun }
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun if (min_error == 0)
171*4882a593Smuzhiyun break;
172*4882a593Smuzhiyun }
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun return min_error == 0;
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun
177*4882a593Smuzhiyun /**
178*4882a593Smuzhiyun * Returns a set of divisors for the desired target clock with the given refclk,
179*4882a593Smuzhiyun * or FALSE. Divisor values are the actual divisors for
180*4882a593Smuzhiyun */
mrst_lvds_find_best_pll(const struct gma_limit_t * limit,struct drm_crtc * crtc,int target,int refclk,struct gma_clock_t * best_clock)181*4882a593Smuzhiyun static bool mrst_lvds_find_best_pll(const struct gma_limit_t *limit,
182*4882a593Smuzhiyun struct drm_crtc *crtc, int target,
183*4882a593Smuzhiyun int refclk, struct gma_clock_t *best_clock)
184*4882a593Smuzhiyun {
185*4882a593Smuzhiyun struct gma_clock_t clock;
186*4882a593Smuzhiyun int err = target;
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun memset(best_clock, 0, sizeof(*best_clock));
189*4882a593Smuzhiyun memset(&clock, 0, sizeof(clock));
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun for (clock.m = limit->m.min; clock.m <= limit->m.max; clock.m++) {
192*4882a593Smuzhiyun for (clock.p1 = limit->p1.min; clock.p1 <= limit->p1.max;
193*4882a593Smuzhiyun clock.p1++) {
194*4882a593Smuzhiyun int this_err;
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun mrst_lvds_clock(refclk, &clock);
197*4882a593Smuzhiyun
198*4882a593Smuzhiyun this_err = abs(clock.dot - target);
199*4882a593Smuzhiyun if (this_err < err) {
200*4882a593Smuzhiyun *best_clock = clock;
201*4882a593Smuzhiyun err = this_err;
202*4882a593Smuzhiyun }
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun return err != target;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun
208*4882a593Smuzhiyun /**
209*4882a593Smuzhiyun * Sets the power management mode of the pipe and plane.
210*4882a593Smuzhiyun *
211*4882a593Smuzhiyun * This code should probably grow support for turning the cursor off and back
212*4882a593Smuzhiyun * on appropriately at the same time as we're turning the pipe off/on.
213*4882a593Smuzhiyun */
oaktrail_crtc_dpms(struct drm_crtc * crtc,int mode)214*4882a593Smuzhiyun static void oaktrail_crtc_dpms(struct drm_crtc *crtc, int mode)
215*4882a593Smuzhiyun {
216*4882a593Smuzhiyun struct drm_device *dev = crtc->dev;
217*4882a593Smuzhiyun struct drm_psb_private *dev_priv = dev->dev_private;
218*4882a593Smuzhiyun struct gma_crtc *gma_crtc = to_gma_crtc(crtc);
219*4882a593Smuzhiyun int pipe = gma_crtc->pipe;
220*4882a593Smuzhiyun const struct psb_offset *map = &dev_priv->regmap[pipe];
221*4882a593Smuzhiyun u32 temp;
222*4882a593Smuzhiyun int i;
223*4882a593Smuzhiyun int need_aux = gma_pipe_has_type(crtc, INTEL_OUTPUT_SDVO) ? 1 : 0;
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun if (gma_pipe_has_type(crtc, INTEL_OUTPUT_HDMI)) {
226*4882a593Smuzhiyun oaktrail_crtc_hdmi_dpms(crtc, mode);
227*4882a593Smuzhiyun return;
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun
230*4882a593Smuzhiyun if (!gma_power_begin(dev, true))
231*4882a593Smuzhiyun return;
232*4882a593Smuzhiyun
233*4882a593Smuzhiyun /* XXX: When our outputs are all unaware of DPMS modes other than off
234*4882a593Smuzhiyun * and on, we should map those modes to DRM_MODE_DPMS_OFF in the CRTC.
235*4882a593Smuzhiyun */
236*4882a593Smuzhiyun switch (mode) {
237*4882a593Smuzhiyun case DRM_MODE_DPMS_ON:
238*4882a593Smuzhiyun case DRM_MODE_DPMS_STANDBY:
239*4882a593Smuzhiyun case DRM_MODE_DPMS_SUSPEND:
240*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
241*4882a593Smuzhiyun /* Enable the DPLL */
242*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->dpll, i);
243*4882a593Smuzhiyun if ((temp & DPLL_VCO_ENABLE) == 0) {
244*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll, temp, i);
245*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
246*4882a593Smuzhiyun /* Wait for the clocks to stabilize. */
247*4882a593Smuzhiyun udelay(150);
248*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll,
249*4882a593Smuzhiyun temp | DPLL_VCO_ENABLE, i);
250*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
251*4882a593Smuzhiyun /* Wait for the clocks to stabilize. */
252*4882a593Smuzhiyun udelay(150);
253*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll,
254*4882a593Smuzhiyun temp | DPLL_VCO_ENABLE, i);
255*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
256*4882a593Smuzhiyun /* Wait for the clocks to stabilize. */
257*4882a593Smuzhiyun udelay(150);
258*4882a593Smuzhiyun }
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun /* Enable the pipe */
261*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->conf, i);
262*4882a593Smuzhiyun if ((temp & PIPEACONF_ENABLE) == 0) {
263*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->conf,
264*4882a593Smuzhiyun temp | PIPEACONF_ENABLE, i);
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun
267*4882a593Smuzhiyun /* Enable the plane */
268*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->cntr, i);
269*4882a593Smuzhiyun if ((temp & DISPLAY_PLANE_ENABLE) == 0) {
270*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->cntr,
271*4882a593Smuzhiyun temp | DISPLAY_PLANE_ENABLE,
272*4882a593Smuzhiyun i);
273*4882a593Smuzhiyun /* Flush the plane changes */
274*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->base,
275*4882a593Smuzhiyun REG_READ_WITH_AUX(map->base, i), i);
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun }
279*4882a593Smuzhiyun gma_crtc_load_lut(crtc);
280*4882a593Smuzhiyun
281*4882a593Smuzhiyun /* Give the overlay scaler a chance to enable
282*4882a593Smuzhiyun if it's on this pipe */
283*4882a593Smuzhiyun /* psb_intel_crtc_dpms_video(crtc, true); TODO */
284*4882a593Smuzhiyun break;
285*4882a593Smuzhiyun case DRM_MODE_DPMS_OFF:
286*4882a593Smuzhiyun /* Give the overlay scaler a chance to disable
287*4882a593Smuzhiyun * if it's on this pipe */
288*4882a593Smuzhiyun /* psb_intel_crtc_dpms_video(crtc, FALSE); TODO */
289*4882a593Smuzhiyun
290*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
291*4882a593Smuzhiyun /* Disable the VGA plane that we never use */
292*4882a593Smuzhiyun REG_WRITE_WITH_AUX(VGACNTRL, VGA_DISP_DISABLE, i);
293*4882a593Smuzhiyun /* Disable display plane */
294*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->cntr, i);
295*4882a593Smuzhiyun if ((temp & DISPLAY_PLANE_ENABLE) != 0) {
296*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->cntr,
297*4882a593Smuzhiyun temp & ~DISPLAY_PLANE_ENABLE, i);
298*4882a593Smuzhiyun /* Flush the plane changes */
299*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->base,
300*4882a593Smuzhiyun REG_READ(map->base), i);
301*4882a593Smuzhiyun REG_READ_WITH_AUX(map->base, i);
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun /* Next, disable display pipes */
305*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->conf, i);
306*4882a593Smuzhiyun if ((temp & PIPEACONF_ENABLE) != 0) {
307*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->conf,
308*4882a593Smuzhiyun temp & ~PIPEACONF_ENABLE, i);
309*4882a593Smuzhiyun REG_READ_WITH_AUX(map->conf, i);
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun /* Wait for for the pipe disable to take effect. */
312*4882a593Smuzhiyun gma_wait_for_vblank(dev);
313*4882a593Smuzhiyun
314*4882a593Smuzhiyun temp = REG_READ_WITH_AUX(map->dpll, i);
315*4882a593Smuzhiyun if ((temp & DPLL_VCO_ENABLE) != 0) {
316*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll,
317*4882a593Smuzhiyun temp & ~DPLL_VCO_ENABLE, i);
318*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
319*4882a593Smuzhiyun }
320*4882a593Smuzhiyun
321*4882a593Smuzhiyun /* Wait for the clocks to turn off. */
322*4882a593Smuzhiyun udelay(150);
323*4882a593Smuzhiyun }
324*4882a593Smuzhiyun break;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun
327*4882a593Smuzhiyun /* Set FIFO Watermarks (values taken from EMGD) */
328*4882a593Smuzhiyun REG_WRITE(DSPARB, 0x3f80);
329*4882a593Smuzhiyun REG_WRITE(DSPFW1, 0x3f8f0404);
330*4882a593Smuzhiyun REG_WRITE(DSPFW2, 0x04040f04);
331*4882a593Smuzhiyun REG_WRITE(DSPFW3, 0x0);
332*4882a593Smuzhiyun REG_WRITE(DSPFW4, 0x04040404);
333*4882a593Smuzhiyun REG_WRITE(DSPFW5, 0x04040404);
334*4882a593Smuzhiyun REG_WRITE(DSPFW6, 0x78);
335*4882a593Smuzhiyun REG_WRITE(DSPCHICKENBIT, REG_READ(DSPCHICKENBIT) | 0xc040);
336*4882a593Smuzhiyun
337*4882a593Smuzhiyun gma_power_end(dev);
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun
340*4882a593Smuzhiyun /**
341*4882a593Smuzhiyun * Return the pipe currently connected to the panel fitter,
342*4882a593Smuzhiyun * or -1 if the panel fitter is not present or not in use
343*4882a593Smuzhiyun */
oaktrail_panel_fitter_pipe(struct drm_device * dev)344*4882a593Smuzhiyun static int oaktrail_panel_fitter_pipe(struct drm_device *dev)
345*4882a593Smuzhiyun {
346*4882a593Smuzhiyun u32 pfit_control;
347*4882a593Smuzhiyun
348*4882a593Smuzhiyun pfit_control = REG_READ(PFIT_CONTROL);
349*4882a593Smuzhiyun
350*4882a593Smuzhiyun /* See if the panel fitter is in use */
351*4882a593Smuzhiyun if ((pfit_control & PFIT_ENABLE) == 0)
352*4882a593Smuzhiyun return -1;
353*4882a593Smuzhiyun return (pfit_control >> 29) & 3;
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun
oaktrail_crtc_mode_set(struct drm_crtc * crtc,struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode,int x,int y,struct drm_framebuffer * old_fb)356*4882a593Smuzhiyun static int oaktrail_crtc_mode_set(struct drm_crtc *crtc,
357*4882a593Smuzhiyun struct drm_display_mode *mode,
358*4882a593Smuzhiyun struct drm_display_mode *adjusted_mode,
359*4882a593Smuzhiyun int x, int y,
360*4882a593Smuzhiyun struct drm_framebuffer *old_fb)
361*4882a593Smuzhiyun {
362*4882a593Smuzhiyun struct drm_device *dev = crtc->dev;
363*4882a593Smuzhiyun struct gma_crtc *gma_crtc = to_gma_crtc(crtc);
364*4882a593Smuzhiyun struct drm_psb_private *dev_priv = dev->dev_private;
365*4882a593Smuzhiyun int pipe = gma_crtc->pipe;
366*4882a593Smuzhiyun const struct psb_offset *map = &dev_priv->regmap[pipe];
367*4882a593Smuzhiyun int refclk = 0;
368*4882a593Smuzhiyun struct gma_clock_t clock;
369*4882a593Smuzhiyun const struct gma_limit_t *limit;
370*4882a593Smuzhiyun u32 dpll = 0, fp = 0, dspcntr, pipeconf;
371*4882a593Smuzhiyun bool ok, is_sdvo = false;
372*4882a593Smuzhiyun bool is_lvds = false;
373*4882a593Smuzhiyun bool is_mipi = false;
374*4882a593Smuzhiyun struct drm_mode_config *mode_config = &dev->mode_config;
375*4882a593Smuzhiyun struct gma_encoder *gma_encoder = NULL;
376*4882a593Smuzhiyun uint64_t scalingType = DRM_MODE_SCALE_FULLSCREEN;
377*4882a593Smuzhiyun struct drm_connector *connector;
378*4882a593Smuzhiyun int i;
379*4882a593Smuzhiyun int need_aux = gma_pipe_has_type(crtc, INTEL_OUTPUT_SDVO) ? 1 : 0;
380*4882a593Smuzhiyun
381*4882a593Smuzhiyun if (gma_pipe_has_type(crtc, INTEL_OUTPUT_HDMI))
382*4882a593Smuzhiyun return oaktrail_crtc_hdmi_mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
383*4882a593Smuzhiyun
384*4882a593Smuzhiyun if (!gma_power_begin(dev, true))
385*4882a593Smuzhiyun return 0;
386*4882a593Smuzhiyun
387*4882a593Smuzhiyun memcpy(&gma_crtc->saved_mode,
388*4882a593Smuzhiyun mode,
389*4882a593Smuzhiyun sizeof(struct drm_display_mode));
390*4882a593Smuzhiyun memcpy(&gma_crtc->saved_adjusted_mode,
391*4882a593Smuzhiyun adjusted_mode,
392*4882a593Smuzhiyun sizeof(struct drm_display_mode));
393*4882a593Smuzhiyun
394*4882a593Smuzhiyun list_for_each_entry(connector, &mode_config->connector_list, head) {
395*4882a593Smuzhiyun if (!connector->encoder || connector->encoder->crtc != crtc)
396*4882a593Smuzhiyun continue;
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun gma_encoder = gma_attached_encoder(connector);
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun switch (gma_encoder->type) {
401*4882a593Smuzhiyun case INTEL_OUTPUT_LVDS:
402*4882a593Smuzhiyun is_lvds = true;
403*4882a593Smuzhiyun break;
404*4882a593Smuzhiyun case INTEL_OUTPUT_SDVO:
405*4882a593Smuzhiyun is_sdvo = true;
406*4882a593Smuzhiyun break;
407*4882a593Smuzhiyun case INTEL_OUTPUT_MIPI:
408*4882a593Smuzhiyun is_mipi = true;
409*4882a593Smuzhiyun break;
410*4882a593Smuzhiyun }
411*4882a593Smuzhiyun }
412*4882a593Smuzhiyun
413*4882a593Smuzhiyun /* Disable the VGA plane that we never use */
414*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++)
415*4882a593Smuzhiyun REG_WRITE_WITH_AUX(VGACNTRL, VGA_DISP_DISABLE, i);
416*4882a593Smuzhiyun
417*4882a593Smuzhiyun /* Disable the panel fitter if it was on our pipe */
418*4882a593Smuzhiyun if (oaktrail_panel_fitter_pipe(dev) == pipe)
419*4882a593Smuzhiyun REG_WRITE(PFIT_CONTROL, 0);
420*4882a593Smuzhiyun
421*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
422*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->src, ((mode->crtc_hdisplay - 1) << 16) |
423*4882a593Smuzhiyun (mode->crtc_vdisplay - 1), i);
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun
426*4882a593Smuzhiyun if (gma_encoder)
427*4882a593Smuzhiyun drm_object_property_get_value(&connector->base,
428*4882a593Smuzhiyun dev->mode_config.scaling_mode_property, &scalingType);
429*4882a593Smuzhiyun
430*4882a593Smuzhiyun if (scalingType == DRM_MODE_SCALE_NO_SCALE) {
431*4882a593Smuzhiyun /* Moorestown doesn't have register support for centering so
432*4882a593Smuzhiyun * we need to mess with the h/vblank and h/vsync start and
433*4882a593Smuzhiyun * ends to get centering */
434*4882a593Smuzhiyun int offsetX = 0, offsetY = 0;
435*4882a593Smuzhiyun
436*4882a593Smuzhiyun offsetX = (adjusted_mode->crtc_hdisplay -
437*4882a593Smuzhiyun mode->crtc_hdisplay) / 2;
438*4882a593Smuzhiyun offsetY = (adjusted_mode->crtc_vdisplay -
439*4882a593Smuzhiyun mode->crtc_vdisplay) / 2;
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
442*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->htotal, (mode->crtc_hdisplay - 1) |
443*4882a593Smuzhiyun ((adjusted_mode->crtc_htotal - 1) << 16), i);
444*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vtotal, (mode->crtc_vdisplay - 1) |
445*4882a593Smuzhiyun ((adjusted_mode->crtc_vtotal - 1) << 16), i);
446*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->hblank,
447*4882a593Smuzhiyun (adjusted_mode->crtc_hblank_start - offsetX - 1) |
448*4882a593Smuzhiyun ((adjusted_mode->crtc_hblank_end - offsetX - 1) << 16), i);
449*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->hsync,
450*4882a593Smuzhiyun (adjusted_mode->crtc_hsync_start - offsetX - 1) |
451*4882a593Smuzhiyun ((adjusted_mode->crtc_hsync_end - offsetX - 1) << 16), i);
452*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vblank,
453*4882a593Smuzhiyun (adjusted_mode->crtc_vblank_start - offsetY - 1) |
454*4882a593Smuzhiyun ((adjusted_mode->crtc_vblank_end - offsetY - 1) << 16), i);
455*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vsync,
456*4882a593Smuzhiyun (adjusted_mode->crtc_vsync_start - offsetY - 1) |
457*4882a593Smuzhiyun ((adjusted_mode->crtc_vsync_end - offsetY - 1) << 16), i);
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun } else {
460*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
461*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->htotal, (adjusted_mode->crtc_hdisplay - 1) |
462*4882a593Smuzhiyun ((adjusted_mode->crtc_htotal - 1) << 16), i);
463*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vtotal, (adjusted_mode->crtc_vdisplay - 1) |
464*4882a593Smuzhiyun ((adjusted_mode->crtc_vtotal - 1) << 16), i);
465*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->hblank, (adjusted_mode->crtc_hblank_start - 1) |
466*4882a593Smuzhiyun ((adjusted_mode->crtc_hblank_end - 1) << 16), i);
467*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->hsync, (adjusted_mode->crtc_hsync_start - 1) |
468*4882a593Smuzhiyun ((adjusted_mode->crtc_hsync_end - 1) << 16), i);
469*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vblank, (adjusted_mode->crtc_vblank_start - 1) |
470*4882a593Smuzhiyun ((adjusted_mode->crtc_vblank_end - 1) << 16), i);
471*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->vsync, (adjusted_mode->crtc_vsync_start - 1) |
472*4882a593Smuzhiyun ((adjusted_mode->crtc_vsync_end - 1) << 16), i);
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun }
475*4882a593Smuzhiyun
476*4882a593Smuzhiyun /* Flush the plane changes */
477*4882a593Smuzhiyun {
478*4882a593Smuzhiyun const struct drm_crtc_helper_funcs *crtc_funcs =
479*4882a593Smuzhiyun crtc->helper_private;
480*4882a593Smuzhiyun crtc_funcs->mode_set_base(crtc, x, y, old_fb);
481*4882a593Smuzhiyun }
482*4882a593Smuzhiyun
483*4882a593Smuzhiyun /* setup pipeconf */
484*4882a593Smuzhiyun pipeconf = REG_READ(map->conf);
485*4882a593Smuzhiyun
486*4882a593Smuzhiyun /* Set up the display plane register */
487*4882a593Smuzhiyun dspcntr = REG_READ(map->cntr);
488*4882a593Smuzhiyun dspcntr |= DISPPLANE_GAMMA_ENABLE;
489*4882a593Smuzhiyun
490*4882a593Smuzhiyun if (pipe == 0)
491*4882a593Smuzhiyun dspcntr |= DISPPLANE_SEL_PIPE_A;
492*4882a593Smuzhiyun else
493*4882a593Smuzhiyun dspcntr |= DISPPLANE_SEL_PIPE_B;
494*4882a593Smuzhiyun
495*4882a593Smuzhiyun if (is_mipi)
496*4882a593Smuzhiyun goto oaktrail_crtc_mode_set_exit;
497*4882a593Smuzhiyun
498*4882a593Smuzhiyun
499*4882a593Smuzhiyun dpll = 0; /*BIT16 = 0 for 100MHz reference */
500*4882a593Smuzhiyun
501*4882a593Smuzhiyun refclk = is_sdvo ? 96000 : dev_priv->core_freq * 1000;
502*4882a593Smuzhiyun limit = mrst_limit(crtc, refclk);
503*4882a593Smuzhiyun ok = limit->find_pll(limit, crtc, adjusted_mode->clock,
504*4882a593Smuzhiyun refclk, &clock);
505*4882a593Smuzhiyun
506*4882a593Smuzhiyun if (is_sdvo) {
507*4882a593Smuzhiyun /* Convert calculated values to register values */
508*4882a593Smuzhiyun clock.p1 = (1L << (clock.p1 - 1));
509*4882a593Smuzhiyun clock.m -= 2;
510*4882a593Smuzhiyun clock.n = (1L << (clock.n - 1));
511*4882a593Smuzhiyun }
512*4882a593Smuzhiyun
513*4882a593Smuzhiyun if (!ok)
514*4882a593Smuzhiyun DRM_ERROR("Failed to find proper PLL settings");
515*4882a593Smuzhiyun
516*4882a593Smuzhiyun mrst_print_pll(&clock);
517*4882a593Smuzhiyun
518*4882a593Smuzhiyun if (is_sdvo)
519*4882a593Smuzhiyun fp = clock.n << 16 | clock.m;
520*4882a593Smuzhiyun else
521*4882a593Smuzhiyun fp = oaktrail_m_converts[(clock.m - MRST_M_MIN)] << 8;
522*4882a593Smuzhiyun
523*4882a593Smuzhiyun dpll |= DPLL_VGA_MODE_DIS;
524*4882a593Smuzhiyun
525*4882a593Smuzhiyun
526*4882a593Smuzhiyun dpll |= DPLL_VCO_ENABLE;
527*4882a593Smuzhiyun
528*4882a593Smuzhiyun if (is_lvds)
529*4882a593Smuzhiyun dpll |= DPLLA_MODE_LVDS;
530*4882a593Smuzhiyun else
531*4882a593Smuzhiyun dpll |= DPLLB_MODE_DAC_SERIAL;
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun if (is_sdvo) {
534*4882a593Smuzhiyun int sdvo_pixel_multiply =
535*4882a593Smuzhiyun adjusted_mode->clock / mode->clock;
536*4882a593Smuzhiyun
537*4882a593Smuzhiyun dpll |= DPLL_DVO_HIGH_SPEED;
538*4882a593Smuzhiyun dpll |=
539*4882a593Smuzhiyun (sdvo_pixel_multiply -
540*4882a593Smuzhiyun 1) << SDVO_MULTIPLIER_SHIFT_HIRES;
541*4882a593Smuzhiyun }
542*4882a593Smuzhiyun
543*4882a593Smuzhiyun
544*4882a593Smuzhiyun /* compute bitmask from p1 value */
545*4882a593Smuzhiyun if (is_sdvo)
546*4882a593Smuzhiyun dpll |= clock.p1 << 16; // dpll |= (1 << (clock.p1 - 1)) << 16;
547*4882a593Smuzhiyun else
548*4882a593Smuzhiyun dpll |= (1 << (clock.p1 - 2)) << 17;
549*4882a593Smuzhiyun
550*4882a593Smuzhiyun dpll |= DPLL_VCO_ENABLE;
551*4882a593Smuzhiyun
552*4882a593Smuzhiyun if (dpll & DPLL_VCO_ENABLE) {
553*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
554*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->fp0, fp, i);
555*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll, dpll & ~DPLL_VCO_ENABLE, i);
556*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
557*4882a593Smuzhiyun /* Check the DPLLA lock bit PIPEACONF[29] */
558*4882a593Smuzhiyun udelay(150);
559*4882a593Smuzhiyun }
560*4882a593Smuzhiyun }
561*4882a593Smuzhiyun
562*4882a593Smuzhiyun for (i = 0; i <= need_aux; i++) {
563*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->fp0, fp, i);
564*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll, dpll, i);
565*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
566*4882a593Smuzhiyun /* Wait for the clocks to stabilize. */
567*4882a593Smuzhiyun udelay(150);
568*4882a593Smuzhiyun
569*4882a593Smuzhiyun /* write it again -- the BIOS does, after all */
570*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->dpll, dpll, i);
571*4882a593Smuzhiyun REG_READ_WITH_AUX(map->dpll, i);
572*4882a593Smuzhiyun /* Wait for the clocks to stabilize. */
573*4882a593Smuzhiyun udelay(150);
574*4882a593Smuzhiyun
575*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->conf, pipeconf, i);
576*4882a593Smuzhiyun REG_READ_WITH_AUX(map->conf, i);
577*4882a593Smuzhiyun gma_wait_for_vblank(dev);
578*4882a593Smuzhiyun
579*4882a593Smuzhiyun REG_WRITE_WITH_AUX(map->cntr, dspcntr, i);
580*4882a593Smuzhiyun gma_wait_for_vblank(dev);
581*4882a593Smuzhiyun }
582*4882a593Smuzhiyun
583*4882a593Smuzhiyun oaktrail_crtc_mode_set_exit:
584*4882a593Smuzhiyun gma_power_end(dev);
585*4882a593Smuzhiyun return 0;
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun
oaktrail_pipe_set_base(struct drm_crtc * crtc,int x,int y,struct drm_framebuffer * old_fb)588*4882a593Smuzhiyun static int oaktrail_pipe_set_base(struct drm_crtc *crtc,
589*4882a593Smuzhiyun int x, int y, struct drm_framebuffer *old_fb)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun struct drm_device *dev = crtc->dev;
592*4882a593Smuzhiyun struct drm_psb_private *dev_priv = dev->dev_private;
593*4882a593Smuzhiyun struct gma_crtc *gma_crtc = to_gma_crtc(crtc);
594*4882a593Smuzhiyun struct drm_framebuffer *fb = crtc->primary->fb;
595*4882a593Smuzhiyun int pipe = gma_crtc->pipe;
596*4882a593Smuzhiyun const struct psb_offset *map = &dev_priv->regmap[pipe];
597*4882a593Smuzhiyun unsigned long start, offset;
598*4882a593Smuzhiyun
599*4882a593Smuzhiyun u32 dspcntr;
600*4882a593Smuzhiyun int ret = 0;
601*4882a593Smuzhiyun
602*4882a593Smuzhiyun /* no fb bound */
603*4882a593Smuzhiyun if (!fb) {
604*4882a593Smuzhiyun dev_dbg(dev->dev, "No FB bound\n");
605*4882a593Smuzhiyun return 0;
606*4882a593Smuzhiyun }
607*4882a593Smuzhiyun
608*4882a593Smuzhiyun if (!gma_power_begin(dev, true))
609*4882a593Smuzhiyun return 0;
610*4882a593Smuzhiyun
611*4882a593Smuzhiyun start = to_gtt_range(fb->obj[0])->offset;
612*4882a593Smuzhiyun offset = y * fb->pitches[0] + x * fb->format->cpp[0];
613*4882a593Smuzhiyun
614*4882a593Smuzhiyun REG_WRITE(map->stride, fb->pitches[0]);
615*4882a593Smuzhiyun
616*4882a593Smuzhiyun dspcntr = REG_READ(map->cntr);
617*4882a593Smuzhiyun dspcntr &= ~DISPPLANE_PIXFORMAT_MASK;
618*4882a593Smuzhiyun
619*4882a593Smuzhiyun switch (fb->format->cpp[0] * 8) {
620*4882a593Smuzhiyun case 8:
621*4882a593Smuzhiyun dspcntr |= DISPPLANE_8BPP;
622*4882a593Smuzhiyun break;
623*4882a593Smuzhiyun case 16:
624*4882a593Smuzhiyun if (fb->format->depth == 15)
625*4882a593Smuzhiyun dspcntr |= DISPPLANE_15_16BPP;
626*4882a593Smuzhiyun else
627*4882a593Smuzhiyun dspcntr |= DISPPLANE_16BPP;
628*4882a593Smuzhiyun break;
629*4882a593Smuzhiyun case 24:
630*4882a593Smuzhiyun case 32:
631*4882a593Smuzhiyun dspcntr |= DISPPLANE_32BPP_NO_ALPHA;
632*4882a593Smuzhiyun break;
633*4882a593Smuzhiyun default:
634*4882a593Smuzhiyun dev_err(dev->dev, "Unknown color depth\n");
635*4882a593Smuzhiyun ret = -EINVAL;
636*4882a593Smuzhiyun goto pipe_set_base_exit;
637*4882a593Smuzhiyun }
638*4882a593Smuzhiyun REG_WRITE(map->cntr, dspcntr);
639*4882a593Smuzhiyun
640*4882a593Smuzhiyun REG_WRITE(map->base, offset);
641*4882a593Smuzhiyun REG_READ(map->base);
642*4882a593Smuzhiyun REG_WRITE(map->surf, start);
643*4882a593Smuzhiyun REG_READ(map->surf);
644*4882a593Smuzhiyun
645*4882a593Smuzhiyun pipe_set_base_exit:
646*4882a593Smuzhiyun gma_power_end(dev);
647*4882a593Smuzhiyun return ret;
648*4882a593Smuzhiyun }
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun const struct drm_crtc_helper_funcs oaktrail_helper_funcs = {
651*4882a593Smuzhiyun .dpms = oaktrail_crtc_dpms,
652*4882a593Smuzhiyun .mode_set = oaktrail_crtc_mode_set,
653*4882a593Smuzhiyun .mode_set_base = oaktrail_pipe_set_base,
654*4882a593Smuzhiyun .prepare = gma_crtc_prepare,
655*4882a593Smuzhiyun .commit = gma_crtc_commit,
656*4882a593Smuzhiyun };
657*4882a593Smuzhiyun
658*4882a593Smuzhiyun /* Not used yet */
659*4882a593Smuzhiyun const struct gma_clock_funcs mrst_clock_funcs = {
660*4882a593Smuzhiyun .clock = mrst_lvds_clock,
661*4882a593Smuzhiyun .limit = mrst_limit,
662*4882a593Smuzhiyun .pll_is_valid = gma_pll_is_valid,
663*4882a593Smuzhiyun };
664