1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
2f7018c21STomi Valkeinen #include "radeonfb.h"
3f7018c21STomi Valkeinen
4f7018c21STomi Valkeinen #include <linux/slab.h>
5f7018c21STomi Valkeinen
6f7018c21STomi Valkeinen #include "../edid.h"
7f7018c21STomi Valkeinen
8ca9384c5SJulia Lawall static const struct fb_var_screeninfo radeonfb_default_var = {
9f7018c21STomi Valkeinen .xres = 640,
10f7018c21STomi Valkeinen .yres = 480,
11f7018c21STomi Valkeinen .xres_virtual = 640,
12f7018c21STomi Valkeinen .yres_virtual = 480,
13f7018c21STomi Valkeinen .bits_per_pixel = 8,
14f7018c21STomi Valkeinen .red = { .length = 8 },
15f7018c21STomi Valkeinen .green = { .length = 8 },
16f7018c21STomi Valkeinen .blue = { .length = 8 },
17f7018c21STomi Valkeinen .activate = FB_ACTIVATE_NOW,
18f7018c21STomi Valkeinen .height = -1,
19f7018c21STomi Valkeinen .width = -1,
20f7018c21STomi Valkeinen .pixclock = 39721,
21f7018c21STomi Valkeinen .left_margin = 40,
22f7018c21STomi Valkeinen .right_margin = 24,
23f7018c21STomi Valkeinen .upper_margin = 32,
24f7018c21STomi Valkeinen .lower_margin = 11,
25f7018c21STomi Valkeinen .hsync_len = 96,
26f7018c21STomi Valkeinen .vsync_len = 2,
27f7018c21STomi Valkeinen .vmode = FB_VMODE_NONINTERLACED
28f7018c21STomi Valkeinen };
29f7018c21STomi Valkeinen
radeon_get_mon_name(int type)30f7018c21STomi Valkeinen static char *radeon_get_mon_name(int type)
31f7018c21STomi Valkeinen {
32f7018c21STomi Valkeinen char *pret = NULL;
33f7018c21STomi Valkeinen
34f7018c21STomi Valkeinen switch (type) {
35f7018c21STomi Valkeinen case MT_NONE:
36f7018c21STomi Valkeinen pret = "no";
37f7018c21STomi Valkeinen break;
38f7018c21STomi Valkeinen case MT_CRT:
39f7018c21STomi Valkeinen pret = "CRT";
40f7018c21STomi Valkeinen break;
41f7018c21STomi Valkeinen case MT_DFP:
42f7018c21STomi Valkeinen pret = "DFP";
43f7018c21STomi Valkeinen break;
44f7018c21STomi Valkeinen case MT_LCD:
45f7018c21STomi Valkeinen pret = "LCD";
46f7018c21STomi Valkeinen break;
47f7018c21STomi Valkeinen case MT_CTV:
48f7018c21STomi Valkeinen pret = "CTV";
49f7018c21STomi Valkeinen break;
50f7018c21STomi Valkeinen case MT_STV:
51f7018c21STomi Valkeinen pret = "STV";
52f7018c21STomi Valkeinen break;
53f7018c21STomi Valkeinen }
54f7018c21STomi Valkeinen
55f7018c21STomi Valkeinen return pret;
56f7018c21STomi Valkeinen }
57f7018c21STomi Valkeinen
58f7018c21STomi Valkeinen
59758ddd1dSKevin Hao #if defined(CONFIG_PPC) || defined(CONFIG_SPARC)
60f7018c21STomi Valkeinen /*
61f7018c21STomi Valkeinen * Try to find monitor informations & EDID data out of the Open Firmware
62f7018c21STomi Valkeinen * device-tree. This also contains some "hacks" to work around a few machine
63f7018c21STomi Valkeinen * models with broken OF probing by hard-coding known EDIDs for some Mac
64f7018c21STomi Valkeinen * laptops internal LVDS panel. (XXX: not done yet)
65f7018c21STomi Valkeinen */
radeon_parse_montype_prop(struct device_node * dp,u8 ** out_EDID,int hdno)66f7018c21STomi Valkeinen static int radeon_parse_montype_prop(struct device_node *dp, u8 **out_EDID,
67f7018c21STomi Valkeinen int hdno)
68f7018c21STomi Valkeinen {
69f7018c21STomi Valkeinen static char *propnames[] = { "DFP,EDID", "LCD,EDID", "EDID",
70f7018c21STomi Valkeinen "EDID1", "EDID2", NULL };
71f7018c21STomi Valkeinen const u8 *pedid = NULL;
72f7018c21STomi Valkeinen const u8 *pmt = NULL;
73f7018c21STomi Valkeinen u8 *tmp;
74f7018c21STomi Valkeinen int i, mt = MT_NONE;
75f7018c21STomi Valkeinen
76f7018c21STomi Valkeinen pr_debug("analyzing OF properties...\n");
77f7018c21STomi Valkeinen pmt = of_get_property(dp, "display-type", NULL);
78f7018c21STomi Valkeinen if (!pmt)
79f7018c21STomi Valkeinen return MT_NONE;
80f7018c21STomi Valkeinen pr_debug("display-type: %s\n", pmt);
81f7018c21STomi Valkeinen /* OF says "LCD" for DFP as well, we discriminate from the caller of this
82f7018c21STomi Valkeinen * function
83f7018c21STomi Valkeinen */
84f7018c21STomi Valkeinen if (!strcmp(pmt, "LCD") || !strcmp(pmt, "DFP"))
85f7018c21STomi Valkeinen mt = MT_DFP;
86f7018c21STomi Valkeinen else if (!strcmp(pmt, "CRT"))
87f7018c21STomi Valkeinen mt = MT_CRT;
88f7018c21STomi Valkeinen else {
89f7018c21STomi Valkeinen if (strcmp(pmt, "NONE") != 0)
90f7018c21STomi Valkeinen printk(KERN_WARNING "radeonfb: Unknown OF display-type: %s\n",
91f7018c21STomi Valkeinen pmt);
92f7018c21STomi Valkeinen return MT_NONE;
93f7018c21STomi Valkeinen }
94f7018c21STomi Valkeinen
95f7018c21STomi Valkeinen for (i = 0; propnames[i] != NULL; ++i) {
96f7018c21STomi Valkeinen pedid = of_get_property(dp, propnames[i], NULL);
97f7018c21STomi Valkeinen if (pedid != NULL)
98f7018c21STomi Valkeinen break;
99f7018c21STomi Valkeinen }
100f7018c21STomi Valkeinen /* We didn't find the EDID in the leaf node, some cards will actually
101f7018c21STomi Valkeinen * put EDID1/EDID2 in the parent, look for these (typically M6 tipb).
102f7018c21STomi Valkeinen * single-head cards have hdno == -1 and skip this step
103f7018c21STomi Valkeinen */
104f7018c21STomi Valkeinen if (pedid == NULL && dp->parent && (hdno != -1))
105f7018c21STomi Valkeinen pedid = of_get_property(dp->parent,
106f7018c21STomi Valkeinen (hdno == 0) ? "EDID1" : "EDID2", NULL);
107f7018c21STomi Valkeinen if (pedid == NULL && dp->parent && (hdno == 0))
108f7018c21STomi Valkeinen pedid = of_get_property(dp->parent, "EDID", NULL);
109f7018c21STomi Valkeinen if (pedid == NULL)
110f7018c21STomi Valkeinen return mt;
111f7018c21STomi Valkeinen
112f7018c21STomi Valkeinen tmp = kmemdup(pedid, EDID_LENGTH, GFP_KERNEL);
113f7018c21STomi Valkeinen if (!tmp)
114f7018c21STomi Valkeinen return mt;
115f7018c21STomi Valkeinen *out_EDID = tmp;
116f7018c21STomi Valkeinen return mt;
117f7018c21STomi Valkeinen }
118f7018c21STomi Valkeinen
radeon_probe_OF_head(struct radeonfb_info * rinfo,int head_no,u8 ** out_EDID)119f7018c21STomi Valkeinen static int radeon_probe_OF_head(struct radeonfb_info *rinfo, int head_no,
120f7018c21STomi Valkeinen u8 **out_EDID)
121f7018c21STomi Valkeinen {
122f7018c21STomi Valkeinen struct device_node *dp;
123f7018c21STomi Valkeinen
124f7018c21STomi Valkeinen pr_debug("radeon_probe_OF_head\n");
125f7018c21STomi Valkeinen
126f7018c21STomi Valkeinen dp = rinfo->of_node;
127f7018c21STomi Valkeinen while (dp == NULL)
128f7018c21STomi Valkeinen return MT_NONE;
129f7018c21STomi Valkeinen
130f7018c21STomi Valkeinen if (rinfo->has_CRTC2) {
131f7018c21STomi Valkeinen const char *pname;
132f7018c21STomi Valkeinen int len, second = 0;
133f7018c21STomi Valkeinen
134f7018c21STomi Valkeinen dp = dp->child;
135f7018c21STomi Valkeinen do {
136f7018c21STomi Valkeinen if (!dp)
137f7018c21STomi Valkeinen return MT_NONE;
138f7018c21STomi Valkeinen pname = of_get_property(dp, "name", NULL);
139f7018c21STomi Valkeinen if (!pname)
140f7018c21STomi Valkeinen return MT_NONE;
141f7018c21STomi Valkeinen len = strlen(pname);
142f7018c21STomi Valkeinen pr_debug("head: %s (letter: %c, head_no: %d)\n",
143f7018c21STomi Valkeinen pname, pname[len-1], head_no);
144f7018c21STomi Valkeinen if (pname[len-1] == 'A' && head_no == 0) {
145f7018c21STomi Valkeinen int mt = radeon_parse_montype_prop(dp, out_EDID, 0);
146f7018c21STomi Valkeinen /* Maybe check for LVDS_GEN_CNTL here ? I need to check out
147f7018c21STomi Valkeinen * what OF does when booting with lid closed
148f7018c21STomi Valkeinen */
149f7018c21STomi Valkeinen if (mt == MT_DFP && rinfo->is_mobility)
150f7018c21STomi Valkeinen mt = MT_LCD;
151f7018c21STomi Valkeinen return mt;
152f7018c21STomi Valkeinen } else if (pname[len-1] == 'B' && head_no == 1)
153f7018c21STomi Valkeinen return radeon_parse_montype_prop(dp, out_EDID, 1);
154f7018c21STomi Valkeinen second = 1;
155f7018c21STomi Valkeinen dp = dp->sibling;
156f7018c21STomi Valkeinen } while(!second);
157f7018c21STomi Valkeinen } else {
158f7018c21STomi Valkeinen if (head_no > 0)
159f7018c21STomi Valkeinen return MT_NONE;
160f7018c21STomi Valkeinen return radeon_parse_montype_prop(dp, out_EDID, -1);
161f7018c21STomi Valkeinen }
162f7018c21STomi Valkeinen return MT_NONE;
163f7018c21STomi Valkeinen }
164758ddd1dSKevin Hao #endif /* CONFIG_PPC || CONFIG_SPARC */
165f7018c21STomi Valkeinen
166f7018c21STomi Valkeinen
radeon_get_panel_info_BIOS(struct radeonfb_info * rinfo)167f7018c21STomi Valkeinen static int radeon_get_panel_info_BIOS(struct radeonfb_info *rinfo)
168f7018c21STomi Valkeinen {
169f7018c21STomi Valkeinen unsigned long tmp, tmp0;
170f7018c21STomi Valkeinen char stmp[30];
171f7018c21STomi Valkeinen int i;
172f7018c21STomi Valkeinen
173f7018c21STomi Valkeinen if (!rinfo->bios_seg)
174f7018c21STomi Valkeinen return 0;
175f7018c21STomi Valkeinen
176f7018c21STomi Valkeinen if (!(tmp = BIOS_IN16(rinfo->fp_bios_start + 0x40))) {
177f7018c21STomi Valkeinen printk(KERN_ERR "radeonfb: Failed to detect DFP panel info using BIOS\n");
178f7018c21STomi Valkeinen rinfo->panel_info.pwr_delay = 200;
179f7018c21STomi Valkeinen return 0;
180f7018c21STomi Valkeinen }
181f7018c21STomi Valkeinen
182f7018c21STomi Valkeinen for(i=0; i<24; i++)
183f7018c21STomi Valkeinen stmp[i] = BIOS_IN8(tmp+i+1);
184f7018c21STomi Valkeinen stmp[24] = 0;
185f7018c21STomi Valkeinen printk("radeonfb: panel ID string: %s\n", stmp);
186f7018c21STomi Valkeinen rinfo->panel_info.xres = BIOS_IN16(tmp + 25);
187f7018c21STomi Valkeinen rinfo->panel_info.yres = BIOS_IN16(tmp + 27);
188f7018c21STomi Valkeinen printk("radeonfb: detected LVDS panel size from BIOS: %dx%d\n",
189f7018c21STomi Valkeinen rinfo->panel_info.xres, rinfo->panel_info.yres);
190f7018c21STomi Valkeinen
191f7018c21STomi Valkeinen rinfo->panel_info.pwr_delay = BIOS_IN16(tmp + 44);
192f7018c21STomi Valkeinen pr_debug("BIOS provided panel power delay: %d\n", rinfo->panel_info.pwr_delay);
193f7018c21STomi Valkeinen if (rinfo->panel_info.pwr_delay > 2000 || rinfo->panel_info.pwr_delay <= 0)
194f7018c21STomi Valkeinen rinfo->panel_info.pwr_delay = 2000;
195f7018c21STomi Valkeinen
196f7018c21STomi Valkeinen /*
197f7018c21STomi Valkeinen * Some panels only work properly with some divider combinations
198f7018c21STomi Valkeinen */
199f7018c21STomi Valkeinen rinfo->panel_info.ref_divider = BIOS_IN16(tmp + 46);
200f7018c21STomi Valkeinen rinfo->panel_info.post_divider = BIOS_IN8(tmp + 48);
201f7018c21STomi Valkeinen rinfo->panel_info.fbk_divider = BIOS_IN16(tmp + 49);
202f7018c21STomi Valkeinen if (rinfo->panel_info.ref_divider != 0 &&
203f7018c21STomi Valkeinen rinfo->panel_info.fbk_divider > 3) {
204f7018c21STomi Valkeinen rinfo->panel_info.use_bios_dividers = 1;
205f7018c21STomi Valkeinen printk(KERN_INFO "radeondb: BIOS provided dividers will be used\n");
206f7018c21STomi Valkeinen pr_debug("ref_divider = %x\n", rinfo->panel_info.ref_divider);
207f7018c21STomi Valkeinen pr_debug("post_divider = %x\n", rinfo->panel_info.post_divider);
208f7018c21STomi Valkeinen pr_debug("fbk_divider = %x\n", rinfo->panel_info.fbk_divider);
209f7018c21STomi Valkeinen }
210f7018c21STomi Valkeinen pr_debug("Scanning BIOS table ...\n");
211f7018c21STomi Valkeinen for(i=0; i<32; i++) {
212f7018c21STomi Valkeinen tmp0 = BIOS_IN16(tmp+64+i*2);
213f7018c21STomi Valkeinen if (tmp0 == 0)
214f7018c21STomi Valkeinen break;
215f7018c21STomi Valkeinen pr_debug(" %d x %d\n", BIOS_IN16(tmp0), BIOS_IN16(tmp0+2));
216f7018c21STomi Valkeinen if ((BIOS_IN16(tmp0) == rinfo->panel_info.xres) &&
217f7018c21STomi Valkeinen (BIOS_IN16(tmp0+2) == rinfo->panel_info.yres)) {
218f7018c21STomi Valkeinen rinfo->panel_info.hblank = (BIOS_IN16(tmp0+17) - BIOS_IN16(tmp0+19)) * 8;
219f7018c21STomi Valkeinen rinfo->panel_info.hOver_plus = ((BIOS_IN16(tmp0+21) -
220f7018c21STomi Valkeinen BIOS_IN16(tmp0+19) -1) * 8) & 0x7fff;
221f7018c21STomi Valkeinen rinfo->panel_info.hSync_width = BIOS_IN8(tmp0+23) * 8;
222f7018c21STomi Valkeinen rinfo->panel_info.vblank = BIOS_IN16(tmp0+24) - BIOS_IN16(tmp0+26);
223f7018c21STomi Valkeinen rinfo->panel_info.vOver_plus = (BIOS_IN16(tmp0+28) & 0x7ff) - BIOS_IN16(tmp0+26);
224f7018c21STomi Valkeinen rinfo->panel_info.vSync_width = (BIOS_IN16(tmp0+28) & 0xf800) >> 11;
225f7018c21STomi Valkeinen rinfo->panel_info.clock = BIOS_IN16(tmp0+9);
226f7018c21STomi Valkeinen /* Assume high active syncs for now until ATI tells me more... maybe we
227f7018c21STomi Valkeinen * can probe register values here ?
228f7018c21STomi Valkeinen */
229f7018c21STomi Valkeinen rinfo->panel_info.hAct_high = 1;
230f7018c21STomi Valkeinen rinfo->panel_info.vAct_high = 1;
231f7018c21STomi Valkeinen /* Mark panel infos valid */
232f7018c21STomi Valkeinen rinfo->panel_info.valid = 1;
233f7018c21STomi Valkeinen
234f7018c21STomi Valkeinen pr_debug("Found panel in BIOS table:\n");
235f7018c21STomi Valkeinen pr_debug(" hblank: %d\n", rinfo->panel_info.hblank);
236f7018c21STomi Valkeinen pr_debug(" hOver_plus: %d\n", rinfo->panel_info.hOver_plus);
237f7018c21STomi Valkeinen pr_debug(" hSync_width: %d\n", rinfo->panel_info.hSync_width);
238f7018c21STomi Valkeinen pr_debug(" vblank: %d\n", rinfo->panel_info.vblank);
239f7018c21STomi Valkeinen pr_debug(" vOver_plus: %d\n", rinfo->panel_info.vOver_plus);
240f7018c21STomi Valkeinen pr_debug(" vSync_width: %d\n", rinfo->panel_info.vSync_width);
241f7018c21STomi Valkeinen pr_debug(" clock: %d\n", rinfo->panel_info.clock);
242f7018c21STomi Valkeinen
243f7018c21STomi Valkeinen return 1;
244f7018c21STomi Valkeinen }
245f7018c21STomi Valkeinen }
246f7018c21STomi Valkeinen pr_debug("Didn't find panel in BIOS table !\n");
247f7018c21STomi Valkeinen
248f7018c21STomi Valkeinen return 0;
249f7018c21STomi Valkeinen }
250f7018c21STomi Valkeinen
251f7018c21STomi Valkeinen /* Try to extract the connector informations from the BIOS. This
252f7018c21STomi Valkeinen * doesn't quite work yet, but it's output is still useful for
253f7018c21STomi Valkeinen * debugging
254f7018c21STomi Valkeinen */
radeon_parse_connector_info(struct radeonfb_info * rinfo)255f7018c21STomi Valkeinen static void radeon_parse_connector_info(struct radeonfb_info *rinfo)
256f7018c21STomi Valkeinen {
257f7018c21STomi Valkeinen int offset, chips, connectors, tmp, i, conn, type;
258f7018c21STomi Valkeinen
259f7018c21STomi Valkeinen static char* __conn_type_table[16] = {
260f7018c21STomi Valkeinen "NONE", "Proprietary", "CRT", "DVI-I", "DVI-D", "Unknown", "Unknown",
261f7018c21STomi Valkeinen "Unknown", "Unknown", "Unknown", "Unknown", "Unknown", "Unknown",
262f7018c21STomi Valkeinen "Unknown", "Unknown", "Unknown"
263f7018c21STomi Valkeinen };
264f7018c21STomi Valkeinen
265f7018c21STomi Valkeinen if (!rinfo->bios_seg)
266f7018c21STomi Valkeinen return;
267f7018c21STomi Valkeinen
268f7018c21STomi Valkeinen offset = BIOS_IN16(rinfo->fp_bios_start + 0x50);
269f7018c21STomi Valkeinen if (offset == 0) {
270f7018c21STomi Valkeinen printk(KERN_WARNING "radeonfb: No connector info table detected\n");
271f7018c21STomi Valkeinen return;
272f7018c21STomi Valkeinen }
273f7018c21STomi Valkeinen
274f7018c21STomi Valkeinen /* Don't do much more at this point but displaying the data if
275f7018c21STomi Valkeinen * DEBUG is enabled
276f7018c21STomi Valkeinen */
277f7018c21STomi Valkeinen chips = BIOS_IN8(offset++) >> 4;
278f7018c21STomi Valkeinen pr_debug("%d chips in connector info\n", chips);
279f7018c21STomi Valkeinen for (i = 0; i < chips; i++) {
280f7018c21STomi Valkeinen tmp = BIOS_IN8(offset++);
281f7018c21STomi Valkeinen connectors = tmp & 0x0f;
282f7018c21STomi Valkeinen pr_debug(" - chip %d has %d connectors\n", tmp >> 4, connectors);
283f7018c21STomi Valkeinen for (conn = 0; ; conn++) {
284f7018c21STomi Valkeinen tmp = BIOS_IN16(offset);
285f7018c21STomi Valkeinen if (tmp == 0)
286f7018c21STomi Valkeinen break;
287f7018c21STomi Valkeinen offset += 2;
288f7018c21STomi Valkeinen type = (tmp >> 12) & 0x0f;
289f7018c21STomi Valkeinen pr_debug(" * connector %d of type %d (%s) : %04x\n",
290f7018c21STomi Valkeinen conn, type, __conn_type_table[type], tmp);
291f7018c21STomi Valkeinen }
292f7018c21STomi Valkeinen }
293f7018c21STomi Valkeinen }
294f7018c21STomi Valkeinen
295f7018c21STomi Valkeinen
296f7018c21STomi Valkeinen /*
297f7018c21STomi Valkeinen * Probe physical connection of a CRT. This code comes from XFree
298f7018c21STomi Valkeinen * as well and currently is only implemented for the CRT DAC, the
299f7018c21STomi Valkeinen * code for the TVDAC is commented out in XFree as "non working"
300f7018c21STomi Valkeinen */
radeon_crt_is_connected(struct radeonfb_info * rinfo,int is_crt_dac)301f7018c21STomi Valkeinen static int radeon_crt_is_connected(struct radeonfb_info *rinfo, int is_crt_dac)
302f7018c21STomi Valkeinen {
303f7018c21STomi Valkeinen int connected = 0;
304f7018c21STomi Valkeinen
305f7018c21STomi Valkeinen /* the monitor either wasn't connected or it is a non-DDC CRT.
306f7018c21STomi Valkeinen * try to probe it
307f7018c21STomi Valkeinen */
308f7018c21STomi Valkeinen if (is_crt_dac) {
309f7018c21STomi Valkeinen unsigned long ulOrigVCLK_ECP_CNTL;
310f7018c21STomi Valkeinen unsigned long ulOrigDAC_CNTL;
311f7018c21STomi Valkeinen unsigned long ulOrigDAC_EXT_CNTL;
312f7018c21STomi Valkeinen unsigned long ulOrigCRTC_EXT_CNTL;
313f7018c21STomi Valkeinen unsigned long ulData;
314f7018c21STomi Valkeinen unsigned long ulMask;
315f7018c21STomi Valkeinen
316f7018c21STomi Valkeinen ulOrigVCLK_ECP_CNTL = INPLL(VCLK_ECP_CNTL);
317f7018c21STomi Valkeinen
318f7018c21STomi Valkeinen ulData = ulOrigVCLK_ECP_CNTL;
319f7018c21STomi Valkeinen ulData &= ~(PIXCLK_ALWAYS_ONb
320f7018c21STomi Valkeinen | PIXCLK_DAC_ALWAYS_ONb);
321f7018c21STomi Valkeinen ulMask = ~(PIXCLK_ALWAYS_ONb
322f7018c21STomi Valkeinen | PIXCLK_DAC_ALWAYS_ONb);
323f7018c21STomi Valkeinen OUTPLLP(VCLK_ECP_CNTL, ulData, ulMask);
324f7018c21STomi Valkeinen
325f7018c21STomi Valkeinen ulOrigCRTC_EXT_CNTL = INREG(CRTC_EXT_CNTL);
326f7018c21STomi Valkeinen ulData = ulOrigCRTC_EXT_CNTL;
327f7018c21STomi Valkeinen ulData |= CRTC_CRT_ON;
328f7018c21STomi Valkeinen OUTREG(CRTC_EXT_CNTL, ulData);
329f7018c21STomi Valkeinen
330f7018c21STomi Valkeinen ulOrigDAC_EXT_CNTL = INREG(DAC_EXT_CNTL);
331f7018c21STomi Valkeinen ulData = ulOrigDAC_EXT_CNTL;
332f7018c21STomi Valkeinen ulData &= ~DAC_FORCE_DATA_MASK;
333f7018c21STomi Valkeinen ulData |= (DAC_FORCE_BLANK_OFF_EN
334f7018c21STomi Valkeinen |DAC_FORCE_DATA_EN
335f7018c21STomi Valkeinen |DAC_FORCE_DATA_SEL_MASK);
336f7018c21STomi Valkeinen if ((rinfo->family == CHIP_FAMILY_RV250) ||
337f7018c21STomi Valkeinen (rinfo->family == CHIP_FAMILY_RV280))
338f7018c21STomi Valkeinen ulData |= (0x01b6 << DAC_FORCE_DATA_SHIFT);
339f7018c21STomi Valkeinen else
340f7018c21STomi Valkeinen ulData |= (0x01ac << DAC_FORCE_DATA_SHIFT);
341f7018c21STomi Valkeinen
342f7018c21STomi Valkeinen OUTREG(DAC_EXT_CNTL, ulData);
343f7018c21STomi Valkeinen
344f7018c21STomi Valkeinen ulOrigDAC_CNTL = INREG(DAC_CNTL);
345f7018c21STomi Valkeinen ulData = ulOrigDAC_CNTL;
346f7018c21STomi Valkeinen ulData |= DAC_CMP_EN;
347f7018c21STomi Valkeinen ulData &= ~(DAC_RANGE_CNTL_MASK
348f7018c21STomi Valkeinen | DAC_PDWN);
349f7018c21STomi Valkeinen ulData |= 0x2;
350f7018c21STomi Valkeinen OUTREG(DAC_CNTL, ulData);
351f7018c21STomi Valkeinen
352f7018c21STomi Valkeinen mdelay(1);
353f7018c21STomi Valkeinen
354f7018c21STomi Valkeinen ulData = INREG(DAC_CNTL);
355f7018c21STomi Valkeinen connected = (DAC_CMP_OUTPUT & ulData) ? 1 : 0;
356f7018c21STomi Valkeinen
357f7018c21STomi Valkeinen ulData = ulOrigVCLK_ECP_CNTL;
358f7018c21STomi Valkeinen ulMask = 0xFFFFFFFFL;
359f7018c21STomi Valkeinen OUTPLLP(VCLK_ECP_CNTL, ulData, ulMask);
360f7018c21STomi Valkeinen
361f7018c21STomi Valkeinen OUTREG(DAC_CNTL, ulOrigDAC_CNTL );
362f7018c21STomi Valkeinen OUTREG(DAC_EXT_CNTL, ulOrigDAC_EXT_CNTL );
363f7018c21STomi Valkeinen OUTREG(CRTC_EXT_CNTL, ulOrigCRTC_EXT_CNTL);
364f7018c21STomi Valkeinen }
365f7018c21STomi Valkeinen
366f7018c21STomi Valkeinen return connected ? MT_CRT : MT_NONE;
367f7018c21STomi Valkeinen }
368f7018c21STomi Valkeinen
369f7018c21STomi Valkeinen /*
370f7018c21STomi Valkeinen * Parse the "monitor_layout" string if any. This code is mostly
371f7018c21STomi Valkeinen * copied from XFree's radeon driver
372f7018c21STomi Valkeinen */
radeon_parse_monitor_layout(struct radeonfb_info * rinfo,const char * monitor_layout)373f7018c21STomi Valkeinen static int radeon_parse_monitor_layout(struct radeonfb_info *rinfo,
374f7018c21STomi Valkeinen const char *monitor_layout)
375f7018c21STomi Valkeinen {
376f7018c21STomi Valkeinen char s1[5], s2[5];
377f7018c21STomi Valkeinen int i = 0, second = 0;
378f7018c21STomi Valkeinen const char *s;
379f7018c21STomi Valkeinen
380f7018c21STomi Valkeinen if (!monitor_layout)
381f7018c21STomi Valkeinen return 0;
382f7018c21STomi Valkeinen
383f7018c21STomi Valkeinen s = monitor_layout;
384f7018c21STomi Valkeinen do {
385f7018c21STomi Valkeinen switch(*s) {
386f7018c21STomi Valkeinen case ',':
387f7018c21STomi Valkeinen s1[i] = '\0';
388f7018c21STomi Valkeinen i = 0;
389f7018c21STomi Valkeinen second = 1;
390f7018c21STomi Valkeinen break;
391f7018c21STomi Valkeinen case ' ':
392f7018c21STomi Valkeinen case '\0':
393f7018c21STomi Valkeinen break;
394f7018c21STomi Valkeinen default:
395f7018c21STomi Valkeinen if (i > 4)
396f7018c21STomi Valkeinen break;
397f7018c21STomi Valkeinen if (second)
398f7018c21STomi Valkeinen s2[i] = *s;
399f7018c21STomi Valkeinen else
400f7018c21STomi Valkeinen s1[i] = *s;
401f7018c21STomi Valkeinen i++;
402f7018c21STomi Valkeinen }
403f7018c21STomi Valkeinen
404f7018c21STomi Valkeinen if (i > 4)
405f7018c21STomi Valkeinen i = 4;
406f7018c21STomi Valkeinen
407f7018c21STomi Valkeinen } while (*s++);
408f7018c21STomi Valkeinen if (second)
409f7018c21STomi Valkeinen s2[i] = 0;
410f7018c21STomi Valkeinen else {
411f7018c21STomi Valkeinen s1[i] = 0;
412f7018c21STomi Valkeinen s2[0] = 0;
413f7018c21STomi Valkeinen }
414f7018c21STomi Valkeinen if (strcmp(s1, "CRT") == 0)
415f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
416f7018c21STomi Valkeinen else if (strcmp(s1, "TMDS") == 0)
417f7018c21STomi Valkeinen rinfo->mon1_type = MT_DFP;
418f7018c21STomi Valkeinen else if (strcmp(s1, "LVDS") == 0)
419f7018c21STomi Valkeinen rinfo->mon1_type = MT_LCD;
420f7018c21STomi Valkeinen
421f7018c21STomi Valkeinen if (strcmp(s2, "CRT") == 0)
422f7018c21STomi Valkeinen rinfo->mon2_type = MT_CRT;
423f7018c21STomi Valkeinen else if (strcmp(s2, "TMDS") == 0)
424f7018c21STomi Valkeinen rinfo->mon2_type = MT_DFP;
425f7018c21STomi Valkeinen else if (strcmp(s2, "LVDS") == 0)
426f7018c21STomi Valkeinen rinfo->mon2_type = MT_LCD;
427f7018c21STomi Valkeinen
428f7018c21STomi Valkeinen return 1;
429f7018c21STomi Valkeinen }
430f7018c21STomi Valkeinen
431f7018c21STomi Valkeinen /*
432f7018c21STomi Valkeinen * Probe display on both primary and secondary card's connector (if any)
433f7018c21STomi Valkeinen * by various available techniques (i2c, OF device tree, BIOS, ...) and
434f7018c21STomi Valkeinen * try to retrieve EDID. The algorithm here comes from XFree's radeon
435f7018c21STomi Valkeinen * driver
436f7018c21STomi Valkeinen */
radeon_probe_screens(struct radeonfb_info * rinfo,const char * monitor_layout,int ignore_edid)437f7018c21STomi Valkeinen void radeon_probe_screens(struct radeonfb_info *rinfo,
438f7018c21STomi Valkeinen const char *monitor_layout, int ignore_edid)
439f7018c21STomi Valkeinen {
440f7018c21STomi Valkeinen #ifdef CONFIG_FB_RADEON_I2C
441f7018c21STomi Valkeinen int ddc_crt2_used = 0;
442f7018c21STomi Valkeinen #endif
443f7018c21STomi Valkeinen int tmp, i;
444f7018c21STomi Valkeinen
445f7018c21STomi Valkeinen radeon_parse_connector_info(rinfo);
446f7018c21STomi Valkeinen
447f7018c21STomi Valkeinen if (radeon_parse_monitor_layout(rinfo, monitor_layout)) {
448f7018c21STomi Valkeinen
449f7018c21STomi Valkeinen /*
450f7018c21STomi Valkeinen * If user specified a monitor_layout option, use it instead
451f7018c21STomi Valkeinen * of auto-detecting. Maybe we should only use this argument
452f7018c21STomi Valkeinen * on the first radeon card probed or provide a way to specify
453f7018c21STomi Valkeinen * a layout for each card ?
454f7018c21STomi Valkeinen */
455f7018c21STomi Valkeinen
456f7018c21STomi Valkeinen pr_debug("Using specified monitor layout: %s", monitor_layout);
457f7018c21STomi Valkeinen #ifdef CONFIG_FB_RADEON_I2C
458f7018c21STomi Valkeinen if (!ignore_edid) {
459f7018c21STomi Valkeinen if (rinfo->mon1_type != MT_NONE)
460f7018c21STomi Valkeinen if (!radeon_probe_i2c_connector(rinfo, ddc_dvi, &rinfo->mon1_EDID)) {
461f7018c21STomi Valkeinen radeon_probe_i2c_connector(rinfo, ddc_crt2, &rinfo->mon1_EDID);
462f7018c21STomi Valkeinen ddc_crt2_used = 1;
463f7018c21STomi Valkeinen }
464f7018c21STomi Valkeinen if (rinfo->mon2_type != MT_NONE)
465f7018c21STomi Valkeinen if (!radeon_probe_i2c_connector(rinfo, ddc_vga, &rinfo->mon2_EDID) &&
466f7018c21STomi Valkeinen !ddc_crt2_used)
467f7018c21STomi Valkeinen radeon_probe_i2c_connector(rinfo, ddc_crt2, &rinfo->mon2_EDID);
468f7018c21STomi Valkeinen }
469f7018c21STomi Valkeinen #endif /* CONFIG_FB_RADEON_I2C */
470f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE) {
471f7018c21STomi Valkeinen if (rinfo->mon2_type != MT_NONE) {
472f7018c21STomi Valkeinen rinfo->mon1_type = rinfo->mon2_type;
473f7018c21STomi Valkeinen rinfo->mon1_EDID = rinfo->mon2_EDID;
474f7018c21STomi Valkeinen } else {
475f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
476f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: No valid monitor, assuming CRT on first port\n");
477f7018c21STomi Valkeinen }
478f7018c21STomi Valkeinen rinfo->mon2_type = MT_NONE;
479f7018c21STomi Valkeinen rinfo->mon2_EDID = NULL;
480f7018c21STomi Valkeinen }
481f7018c21STomi Valkeinen } else {
482f7018c21STomi Valkeinen /*
483f7018c21STomi Valkeinen * Auto-detecting display type (well... trying to ...)
484f7018c21STomi Valkeinen */
485f7018c21STomi Valkeinen
486f7018c21STomi Valkeinen pr_debug("Starting monitor auto detection...\n");
487f7018c21STomi Valkeinen
488f7018c21STomi Valkeinen #if defined(DEBUG) && defined(CONFIG_FB_RADEON_I2C)
489f7018c21STomi Valkeinen {
490f7018c21STomi Valkeinen u8 *EDIDs[4] = { NULL, NULL, NULL, NULL };
491f7018c21STomi Valkeinen int i;
492f7018c21STomi Valkeinen
493f7018c21STomi Valkeinen for (i = 0; i < 4; i++)
494*288b2371SSam Ravnborg radeon_probe_i2c_connector(rinfo, i + 1, &EDIDs[i]);
495f7018c21STomi Valkeinen }
496f7018c21STomi Valkeinen #endif /* DEBUG */
497f7018c21STomi Valkeinen /*
498f7018c21STomi Valkeinen * Old single head cards
499f7018c21STomi Valkeinen */
500f7018c21STomi Valkeinen if (!rinfo->has_CRTC2) {
501758ddd1dSKevin Hao #if defined(CONFIG_PPC) || defined(CONFIG_SPARC)
502f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
503f7018c21STomi Valkeinen rinfo->mon1_type = radeon_probe_OF_head(rinfo, 0,
504f7018c21STomi Valkeinen &rinfo->mon1_EDID);
505758ddd1dSKevin Hao #endif /* CONFIG_PPC || CONFIG_SPARC */
506f7018c21STomi Valkeinen #ifdef CONFIG_FB_RADEON_I2C
507f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
508f7018c21STomi Valkeinen rinfo->mon1_type =
509f7018c21STomi Valkeinen radeon_probe_i2c_connector(rinfo, ddc_dvi,
510f7018c21STomi Valkeinen &rinfo->mon1_EDID);
511f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
512f7018c21STomi Valkeinen rinfo->mon1_type =
513f7018c21STomi Valkeinen radeon_probe_i2c_connector(rinfo, ddc_vga,
514f7018c21STomi Valkeinen &rinfo->mon1_EDID);
515f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
516f7018c21STomi Valkeinen rinfo->mon1_type =
517f7018c21STomi Valkeinen radeon_probe_i2c_connector(rinfo, ddc_crt2,
518f7018c21STomi Valkeinen &rinfo->mon1_EDID);
519f7018c21STomi Valkeinen #endif /* CONFIG_FB_RADEON_I2C */
520f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
521f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
522f7018c21STomi Valkeinen goto bail;
523f7018c21STomi Valkeinen }
524f7018c21STomi Valkeinen
525f7018c21STomi Valkeinen /*
526f7018c21STomi Valkeinen * Check for cards with reversed DACs or TMDS controllers using BIOS
527f7018c21STomi Valkeinen */
528f7018c21STomi Valkeinen if (rinfo->bios_seg &&
529f7018c21STomi Valkeinen (tmp = BIOS_IN16(rinfo->fp_bios_start + 0x50))) {
530f7018c21STomi Valkeinen for (i = 1; i < 4; i++) {
531f7018c21STomi Valkeinen unsigned int tmp0;
532f7018c21STomi Valkeinen
533f7018c21STomi Valkeinen if (!BIOS_IN8(tmp + i*2) && i > 1)
534f7018c21STomi Valkeinen break;
535f7018c21STomi Valkeinen tmp0 = BIOS_IN16(tmp + i*2);
536f7018c21STomi Valkeinen if ((!(tmp0 & 0x01)) && (((tmp0 >> 8) & 0x0f) == ddc_dvi)) {
537f7018c21STomi Valkeinen rinfo->reversed_DAC = 1;
538f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: Reversed DACs detected\n");
539f7018c21STomi Valkeinen }
540f7018c21STomi Valkeinen if ((((tmp0 >> 8) & 0x0f) == ddc_dvi) && ((tmp0 >> 4) & 0x01)) {
541f7018c21STomi Valkeinen rinfo->reversed_TMDS = 1;
542f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: Reversed TMDS detected\n");
543f7018c21STomi Valkeinen }
544f7018c21STomi Valkeinen }
545f7018c21STomi Valkeinen }
546f7018c21STomi Valkeinen
547f7018c21STomi Valkeinen /*
548f7018c21STomi Valkeinen * Probe primary head (DVI or laptop internal panel)
549f7018c21STomi Valkeinen */
550758ddd1dSKevin Hao #if defined(CONFIG_PPC) || defined(CONFIG_SPARC)
551f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
552f7018c21STomi Valkeinen rinfo->mon1_type = radeon_probe_OF_head(rinfo, 0,
553f7018c21STomi Valkeinen &rinfo->mon1_EDID);
554758ddd1dSKevin Hao #endif /* CONFIG_PPC || CONFIG_SPARC */
555f7018c21STomi Valkeinen #ifdef CONFIG_FB_RADEON_I2C
556f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
557f7018c21STomi Valkeinen rinfo->mon1_type = radeon_probe_i2c_connector(rinfo, ddc_dvi,
558f7018c21STomi Valkeinen &rinfo->mon1_EDID);
559f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE) {
560f7018c21STomi Valkeinen rinfo->mon1_type = radeon_probe_i2c_connector(rinfo, ddc_crt2,
561f7018c21STomi Valkeinen &rinfo->mon1_EDID);
562f7018c21STomi Valkeinen if (rinfo->mon1_type != MT_NONE)
563f7018c21STomi Valkeinen ddc_crt2_used = 1;
564f7018c21STomi Valkeinen }
565f7018c21STomi Valkeinen #endif /* CONFIG_FB_RADEON_I2C */
566f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE && rinfo->is_mobility &&
567f7018c21STomi Valkeinen ((rinfo->bios_seg && (INREG(BIOS_4_SCRATCH) & 4))
568f7018c21STomi Valkeinen || (INREG(LVDS_GEN_CNTL) & LVDS_ON))) {
569f7018c21STomi Valkeinen rinfo->mon1_type = MT_LCD;
570f7018c21STomi Valkeinen printk("Non-DDC laptop panel detected\n");
571f7018c21STomi Valkeinen }
572f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE)
573f7018c21STomi Valkeinen rinfo->mon1_type = radeon_crt_is_connected(rinfo, rinfo->reversed_DAC);
574f7018c21STomi Valkeinen
575f7018c21STomi Valkeinen /*
576f7018c21STomi Valkeinen * Probe secondary head (mostly VGA, can be DVI)
577f7018c21STomi Valkeinen */
578758ddd1dSKevin Hao #if defined(CONFIG_PPC) || defined(CONFIG_SPARC)
579f7018c21STomi Valkeinen if (rinfo->mon2_type == MT_NONE)
580f7018c21STomi Valkeinen rinfo->mon2_type = radeon_probe_OF_head(rinfo, 1,
581f7018c21STomi Valkeinen &rinfo->mon2_EDID);
582758ddd1dSKevin Hao #endif /* CONFIG_PPC || defined(CONFIG_SPARC) */
583f7018c21STomi Valkeinen #ifdef CONFIG_FB_RADEON_I2C
584f7018c21STomi Valkeinen if (rinfo->mon2_type == MT_NONE)
585f7018c21STomi Valkeinen rinfo->mon2_type = radeon_probe_i2c_connector(rinfo, ddc_vga,
586f7018c21STomi Valkeinen &rinfo->mon2_EDID);
587f7018c21STomi Valkeinen if (rinfo->mon2_type == MT_NONE && !ddc_crt2_used)
588f7018c21STomi Valkeinen rinfo->mon2_type = radeon_probe_i2c_connector(rinfo, ddc_crt2,
589f7018c21STomi Valkeinen &rinfo->mon2_EDID);
590f7018c21STomi Valkeinen #endif /* CONFIG_FB_RADEON_I2C */
591f7018c21STomi Valkeinen if (rinfo->mon2_type == MT_NONE)
592f7018c21STomi Valkeinen rinfo->mon2_type = radeon_crt_is_connected(rinfo, !rinfo->reversed_DAC);
593f7018c21STomi Valkeinen
594f7018c21STomi Valkeinen /*
595f7018c21STomi Valkeinen * If we only detected port 2, we swap them, if none detected,
596f7018c21STomi Valkeinen * assume CRT (maybe fallback to old BIOS_SCRATCH stuff ? or look
597f7018c21STomi Valkeinen * at FP registers ?)
598f7018c21STomi Valkeinen */
599f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_NONE) {
600f7018c21STomi Valkeinen if (rinfo->mon2_type != MT_NONE) {
601f7018c21STomi Valkeinen rinfo->mon1_type = rinfo->mon2_type;
602f7018c21STomi Valkeinen rinfo->mon1_EDID = rinfo->mon2_EDID;
603f7018c21STomi Valkeinen } else
604f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
605f7018c21STomi Valkeinen rinfo->mon2_type = MT_NONE;
606f7018c21STomi Valkeinen rinfo->mon2_EDID = NULL;
607f7018c21STomi Valkeinen }
608f7018c21STomi Valkeinen
609f7018c21STomi Valkeinen /*
610f7018c21STomi Valkeinen * Deal with reversed TMDS
611f7018c21STomi Valkeinen */
612f7018c21STomi Valkeinen if (rinfo->reversed_TMDS) {
613f7018c21STomi Valkeinen /* Always keep internal TMDS as primary head */
614f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_DFP || rinfo->mon2_type == MT_DFP) {
615f7018c21STomi Valkeinen int tmp_type = rinfo->mon1_type;
616f7018c21STomi Valkeinen u8 *tmp_EDID = rinfo->mon1_EDID;
617f7018c21STomi Valkeinen rinfo->mon1_type = rinfo->mon2_type;
618f7018c21STomi Valkeinen rinfo->mon1_EDID = rinfo->mon2_EDID;
619f7018c21STomi Valkeinen rinfo->mon2_type = tmp_type;
620f7018c21STomi Valkeinen rinfo->mon2_EDID = tmp_EDID;
621f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_CRT || rinfo->mon2_type == MT_CRT)
622f7018c21STomi Valkeinen rinfo->reversed_DAC ^= 1;
623f7018c21STomi Valkeinen }
624f7018c21STomi Valkeinen }
625f7018c21STomi Valkeinen }
626f7018c21STomi Valkeinen if (ignore_edid) {
627f7018c21STomi Valkeinen kfree(rinfo->mon1_EDID);
628f7018c21STomi Valkeinen rinfo->mon1_EDID = NULL;
629f7018c21STomi Valkeinen kfree(rinfo->mon2_EDID);
630f7018c21STomi Valkeinen rinfo->mon2_EDID = NULL;
631f7018c21STomi Valkeinen }
632f7018c21STomi Valkeinen
633f7018c21STomi Valkeinen bail:
634f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: Monitor 1 type %s found\n",
635f7018c21STomi Valkeinen radeon_get_mon_name(rinfo->mon1_type));
636f7018c21STomi Valkeinen if (rinfo->mon1_EDID)
637f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: EDID probed\n");
638f7018c21STomi Valkeinen if (!rinfo->has_CRTC2)
639f7018c21STomi Valkeinen return;
640f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: Monitor 2 type %s found\n",
641f7018c21STomi Valkeinen radeon_get_mon_name(rinfo->mon2_type));
642f7018c21STomi Valkeinen if (rinfo->mon2_EDID)
643f7018c21STomi Valkeinen printk(KERN_INFO "radeonfb: EDID probed\n");
644f7018c21STomi Valkeinen }
645f7018c21STomi Valkeinen
646f7018c21STomi Valkeinen
647f7018c21STomi Valkeinen /*
648a6ab4effSMasahiro Yamada * This function applies any arch/model/machine specific fixups
649f7018c21STomi Valkeinen * to the panel info. It may eventually alter EDID block as
650f7018c21STomi Valkeinen * well or whatever is specific to a given model and not probed
651f7018c21STomi Valkeinen * properly by the default code
652f7018c21STomi Valkeinen */
radeon_fixup_panel_info(struct radeonfb_info * rinfo)653f7018c21STomi Valkeinen static void radeon_fixup_panel_info(struct radeonfb_info *rinfo)
654f7018c21STomi Valkeinen {
655758ddd1dSKevin Hao #ifdef CONFIG_PPC
656f7018c21STomi Valkeinen /*
657f7018c21STomi Valkeinen * LCD Flat panels should use fixed dividers, we enfore that on
658f7018c21STomi Valkeinen * PPC only for now...
659f7018c21STomi Valkeinen */
660f7018c21STomi Valkeinen if (!rinfo->panel_info.use_bios_dividers && rinfo->mon1_type == MT_LCD
661f7018c21STomi Valkeinen && rinfo->is_mobility) {
662f7018c21STomi Valkeinen int ppll_div_sel;
663f7018c21STomi Valkeinen u32 ppll_divn;
664f7018c21STomi Valkeinen ppll_div_sel = INREG8(CLOCK_CNTL_INDEX + 1) & 0x3;
665f7018c21STomi Valkeinen radeon_pll_errata_after_index(rinfo);
666f7018c21STomi Valkeinen ppll_divn = INPLL(PPLL_DIV_0 + ppll_div_sel);
667f7018c21STomi Valkeinen rinfo->panel_info.ref_divider = rinfo->pll.ref_div;
668f7018c21STomi Valkeinen rinfo->panel_info.fbk_divider = ppll_divn & 0x7ff;
669f7018c21STomi Valkeinen rinfo->panel_info.post_divider = (ppll_divn >> 16) & 0x7;
670f7018c21STomi Valkeinen rinfo->panel_info.use_bios_dividers = 1;
671f7018c21STomi Valkeinen
672f7018c21STomi Valkeinen printk(KERN_DEBUG "radeonfb: Using Firmware dividers 0x%08x "
673f7018c21STomi Valkeinen "from PPLL %d\n",
674f7018c21STomi Valkeinen rinfo->panel_info.fbk_divider |
675f7018c21STomi Valkeinen (rinfo->panel_info.post_divider << 16),
676f7018c21STomi Valkeinen ppll_div_sel);
677f7018c21STomi Valkeinen }
678758ddd1dSKevin Hao #endif /* CONFIG_PPC */
679f7018c21STomi Valkeinen }
680f7018c21STomi Valkeinen
681f7018c21STomi Valkeinen
682f7018c21STomi Valkeinen /*
683f7018c21STomi Valkeinen * Fill up panel infos from a mode definition, either returned by the EDID
684f7018c21STomi Valkeinen * or from the default mode when we can't do any better
685f7018c21STomi Valkeinen */
radeon_var_to_panel_info(struct radeonfb_info * rinfo,struct fb_var_screeninfo * var)686f7018c21STomi Valkeinen static void radeon_var_to_panel_info(struct radeonfb_info *rinfo, struct fb_var_screeninfo *var)
687f7018c21STomi Valkeinen {
688f7018c21STomi Valkeinen rinfo->panel_info.xres = var->xres;
689f7018c21STomi Valkeinen rinfo->panel_info.yres = var->yres;
690f7018c21STomi Valkeinen rinfo->panel_info.clock = 100000000 / var->pixclock;
691f7018c21STomi Valkeinen rinfo->panel_info.hOver_plus = var->right_margin;
692f7018c21STomi Valkeinen rinfo->panel_info.hSync_width = var->hsync_len;
693f7018c21STomi Valkeinen rinfo->panel_info.hblank = var->left_margin +
694f7018c21STomi Valkeinen (var->right_margin + var->hsync_len);
695f7018c21STomi Valkeinen rinfo->panel_info.vOver_plus = var->lower_margin;
696f7018c21STomi Valkeinen rinfo->panel_info.vSync_width = var->vsync_len;
697f7018c21STomi Valkeinen rinfo->panel_info.vblank = var->upper_margin +
698f7018c21STomi Valkeinen (var->lower_margin + var->vsync_len);
699f7018c21STomi Valkeinen rinfo->panel_info.hAct_high =
700f7018c21STomi Valkeinen (var->sync & FB_SYNC_HOR_HIGH_ACT) != 0;
701f7018c21STomi Valkeinen rinfo->panel_info.vAct_high =
702f7018c21STomi Valkeinen (var->sync & FB_SYNC_VERT_HIGH_ACT) != 0;
703f7018c21STomi Valkeinen rinfo->panel_info.valid = 1;
704f7018c21STomi Valkeinen /* We use a default of 200ms for the panel power delay,
705f7018c21STomi Valkeinen * I need to have a real schedule() instead of mdelay's in the panel code.
706f7018c21STomi Valkeinen * we might be possible to figure out a better power delay either from
707f7018c21STomi Valkeinen * MacOS OF tree or from the EDID block (proprietary extensions ?)
708f7018c21STomi Valkeinen */
709f7018c21STomi Valkeinen rinfo->panel_info.pwr_delay = 200;
710f7018c21STomi Valkeinen }
711f7018c21STomi Valkeinen
radeon_videomode_to_var(struct fb_var_screeninfo * var,const struct fb_videomode * mode)712f7018c21STomi Valkeinen static void radeon_videomode_to_var(struct fb_var_screeninfo *var,
713f7018c21STomi Valkeinen const struct fb_videomode *mode)
714f7018c21STomi Valkeinen {
715f7018c21STomi Valkeinen var->xres = mode->xres;
716f7018c21STomi Valkeinen var->yres = mode->yres;
717f7018c21STomi Valkeinen var->xres_virtual = mode->xres;
718f7018c21STomi Valkeinen var->yres_virtual = mode->yres;
719f7018c21STomi Valkeinen var->xoffset = 0;
720f7018c21STomi Valkeinen var->yoffset = 0;
721f7018c21STomi Valkeinen var->pixclock = mode->pixclock;
722f7018c21STomi Valkeinen var->left_margin = mode->left_margin;
723f7018c21STomi Valkeinen var->right_margin = mode->right_margin;
724f7018c21STomi Valkeinen var->upper_margin = mode->upper_margin;
725f7018c21STomi Valkeinen var->lower_margin = mode->lower_margin;
726f7018c21STomi Valkeinen var->hsync_len = mode->hsync_len;
727f7018c21STomi Valkeinen var->vsync_len = mode->vsync_len;
728f7018c21STomi Valkeinen var->sync = mode->sync;
729f7018c21STomi Valkeinen var->vmode = mode->vmode;
730f7018c21STomi Valkeinen }
731f7018c21STomi Valkeinen
732f7018c21STomi Valkeinen #ifdef CONFIG_PPC_PSERIES
is_powerblade(const char * model)733f7018c21STomi Valkeinen static int is_powerblade(const char *model)
734f7018c21STomi Valkeinen {
735f7018c21STomi Valkeinen struct device_node *root;
736f7018c21STomi Valkeinen const char* cp;
737f7018c21STomi Valkeinen int len, l, rc = 0;
738f7018c21STomi Valkeinen
739f7018c21STomi Valkeinen root = of_find_node_by_path("/");
740f7018c21STomi Valkeinen if (root && model) {
741f7018c21STomi Valkeinen l = strlen(model);
742f7018c21STomi Valkeinen cp = of_get_property(root, "model", &len);
743f7018c21STomi Valkeinen if (cp)
744f7018c21STomi Valkeinen rc = memcmp(model, cp, min(len, l)) == 0;
745f7018c21STomi Valkeinen of_node_put(root);
746f7018c21STomi Valkeinen }
747f7018c21STomi Valkeinen return rc;
748f7018c21STomi Valkeinen }
749f7018c21STomi Valkeinen #endif
750f7018c21STomi Valkeinen
751f7018c21STomi Valkeinen /*
752f7018c21STomi Valkeinen * Build the modedb for head 1 (head 2 will come later), check panel infos
753f7018c21STomi Valkeinen * from either BIOS or EDID, and pick up the default mode
754f7018c21STomi Valkeinen */
radeon_check_modes(struct radeonfb_info * rinfo,const char * mode_option)755f7018c21STomi Valkeinen void radeon_check_modes(struct radeonfb_info *rinfo, const char *mode_option)
756f7018c21STomi Valkeinen {
757f7018c21STomi Valkeinen struct fb_info * info = rinfo->info;
758f7018c21STomi Valkeinen int has_default_mode = 0;
759f7018c21STomi Valkeinen
760f7018c21STomi Valkeinen /*
761f7018c21STomi Valkeinen * Fill default var first
762f7018c21STomi Valkeinen */
763f7018c21STomi Valkeinen info->var = radeonfb_default_var;
764f7018c21STomi Valkeinen INIT_LIST_HEAD(&info->modelist);
765f7018c21STomi Valkeinen
766f7018c21STomi Valkeinen /*
767f7018c21STomi Valkeinen * First check out what BIOS has to say
768f7018c21STomi Valkeinen */
769f7018c21STomi Valkeinen if (rinfo->mon1_type == MT_LCD)
770f7018c21STomi Valkeinen radeon_get_panel_info_BIOS(rinfo);
771f7018c21STomi Valkeinen
772f7018c21STomi Valkeinen /*
773f7018c21STomi Valkeinen * Parse EDID detailed timings and deduce panel infos if any. Right now
774f7018c21STomi Valkeinen * we only deal with first entry returned by parse_EDID, we may do better
775f7018c21STomi Valkeinen * some day...
776f7018c21STomi Valkeinen */
777f7018c21STomi Valkeinen if (!rinfo->panel_info.use_bios_dividers && rinfo->mon1_type != MT_CRT
778f7018c21STomi Valkeinen && rinfo->mon1_EDID) {
779f7018c21STomi Valkeinen struct fb_var_screeninfo var;
780f7018c21STomi Valkeinen pr_debug("Parsing EDID data for panel info\n");
781f7018c21STomi Valkeinen if (fb_parse_edid(rinfo->mon1_EDID, &var) == 0) {
782f7018c21STomi Valkeinen if (var.xres >= rinfo->panel_info.xres &&
783f7018c21STomi Valkeinen var.yres >= rinfo->panel_info.yres)
784f7018c21STomi Valkeinen radeon_var_to_panel_info(rinfo, &var);
785f7018c21STomi Valkeinen }
786f7018c21STomi Valkeinen }
787f7018c21STomi Valkeinen
788f7018c21STomi Valkeinen /*
789f7018c21STomi Valkeinen * Do any additional platform/arch fixups to the panel infos
790f7018c21STomi Valkeinen */
791f7018c21STomi Valkeinen radeon_fixup_panel_info(rinfo);
792f7018c21STomi Valkeinen
793f7018c21STomi Valkeinen /*
794f7018c21STomi Valkeinen * If we have some valid panel infos, we setup the default mode based on
795f7018c21STomi Valkeinen * those
796f7018c21STomi Valkeinen */
797f7018c21STomi Valkeinen if (rinfo->mon1_type != MT_CRT && rinfo->panel_info.valid) {
798f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &info->var;
799f7018c21STomi Valkeinen
800f7018c21STomi Valkeinen pr_debug("Setting up default mode based on panel info\n");
801f7018c21STomi Valkeinen var->xres = rinfo->panel_info.xres;
802f7018c21STomi Valkeinen var->yres = rinfo->panel_info.yres;
803f7018c21STomi Valkeinen var->xres_virtual = rinfo->panel_info.xres;
804f7018c21STomi Valkeinen var->yres_virtual = rinfo->panel_info.yres;
805f7018c21STomi Valkeinen var->xoffset = var->yoffset = 0;
806f7018c21STomi Valkeinen var->bits_per_pixel = 8;
807f7018c21STomi Valkeinen var->pixclock = 100000000 / rinfo->panel_info.clock;
808f7018c21STomi Valkeinen var->left_margin = (rinfo->panel_info.hblank - rinfo->panel_info.hOver_plus
809f7018c21STomi Valkeinen - rinfo->panel_info.hSync_width);
810f7018c21STomi Valkeinen var->right_margin = rinfo->panel_info.hOver_plus;
811f7018c21STomi Valkeinen var->upper_margin = (rinfo->panel_info.vblank - rinfo->panel_info.vOver_plus
812f7018c21STomi Valkeinen - rinfo->panel_info.vSync_width);
813f7018c21STomi Valkeinen var->lower_margin = rinfo->panel_info.vOver_plus;
814f7018c21STomi Valkeinen var->hsync_len = rinfo->panel_info.hSync_width;
815f7018c21STomi Valkeinen var->vsync_len = rinfo->panel_info.vSync_width;
816f7018c21STomi Valkeinen var->sync = 0;
817f7018c21STomi Valkeinen if (rinfo->panel_info.hAct_high)
818f7018c21STomi Valkeinen var->sync |= FB_SYNC_HOR_HIGH_ACT;
819f7018c21STomi Valkeinen if (rinfo->panel_info.vAct_high)
820f7018c21STomi Valkeinen var->sync |= FB_SYNC_VERT_HIGH_ACT;
821f7018c21STomi Valkeinen var->vmode = 0;
822f7018c21STomi Valkeinen has_default_mode = 1;
823f7018c21STomi Valkeinen }
824f7018c21STomi Valkeinen
825f7018c21STomi Valkeinen /*
826f7018c21STomi Valkeinen * Now build modedb from EDID
827f7018c21STomi Valkeinen */
828f7018c21STomi Valkeinen if (rinfo->mon1_EDID) {
829f7018c21STomi Valkeinen fb_edid_to_monspecs(rinfo->mon1_EDID, &info->monspecs);
830f7018c21STomi Valkeinen fb_videomode_to_modelist(info->monspecs.modedb,
831f7018c21STomi Valkeinen info->monspecs.modedb_len,
832f7018c21STomi Valkeinen &info->modelist);
833f7018c21STomi Valkeinen rinfo->mon1_modedb = info->monspecs.modedb;
834f7018c21STomi Valkeinen rinfo->mon1_dbsize = info->monspecs.modedb_len;
835f7018c21STomi Valkeinen }
836f7018c21STomi Valkeinen
837f7018c21STomi Valkeinen
838f7018c21STomi Valkeinen /*
839f7018c21STomi Valkeinen * Finally, if we don't have panel infos we need to figure some (or
840f7018c21STomi Valkeinen * we try to read it from card), we try to pick a default mode
841f7018c21STomi Valkeinen * and create some panel infos. Whatever...
842f7018c21STomi Valkeinen */
843f7018c21STomi Valkeinen if (rinfo->mon1_type != MT_CRT && !rinfo->panel_info.valid) {
844f7018c21STomi Valkeinen struct fb_videomode *modedb;
845f7018c21STomi Valkeinen int dbsize;
846f7018c21STomi Valkeinen char modename[32];
847f7018c21STomi Valkeinen
848f7018c21STomi Valkeinen pr_debug("Guessing panel info...\n");
849f7018c21STomi Valkeinen if (rinfo->panel_info.xres == 0 || rinfo->panel_info.yres == 0) {
850f7018c21STomi Valkeinen u32 tmp = INREG(FP_HORZ_STRETCH) & HORZ_PANEL_SIZE;
851f7018c21STomi Valkeinen rinfo->panel_info.xres = ((tmp >> HORZ_PANEL_SHIFT) + 1) * 8;
852f7018c21STomi Valkeinen tmp = INREG(FP_VERT_STRETCH) & VERT_PANEL_SIZE;
853f7018c21STomi Valkeinen rinfo->panel_info.yres = (tmp >> VERT_PANEL_SHIFT) + 1;
854f7018c21STomi Valkeinen }
855f7018c21STomi Valkeinen if (rinfo->panel_info.xres == 0 || rinfo->panel_info.yres == 0) {
856f7018c21STomi Valkeinen printk(KERN_WARNING "radeonfb: Can't find panel size, going back to CRT\n");
857f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
858f7018c21STomi Valkeinen goto pickup_default;
859f7018c21STomi Valkeinen }
860f7018c21STomi Valkeinen printk(KERN_WARNING "radeonfb: Assuming panel size %dx%d\n",
861f7018c21STomi Valkeinen rinfo->panel_info.xres, rinfo->panel_info.yres);
862f7018c21STomi Valkeinen modedb = rinfo->mon1_modedb;
863f7018c21STomi Valkeinen dbsize = rinfo->mon1_dbsize;
864f7018c21STomi Valkeinen snprintf(modename, 31, "%dx%d", rinfo->panel_info.xres, rinfo->panel_info.yres);
865f7018c21STomi Valkeinen if (fb_find_mode(&info->var, info, modename,
866f7018c21STomi Valkeinen modedb, dbsize, NULL, 8) == 0) {
867f7018c21STomi Valkeinen printk(KERN_WARNING "radeonfb: Can't find mode for panel size, going back to CRT\n");
868f7018c21STomi Valkeinen rinfo->mon1_type = MT_CRT;
869f7018c21STomi Valkeinen goto pickup_default;
870f7018c21STomi Valkeinen }
871f7018c21STomi Valkeinen has_default_mode = 1;
872f7018c21STomi Valkeinen radeon_var_to_panel_info(rinfo, &info->var);
873f7018c21STomi Valkeinen }
874f7018c21STomi Valkeinen
875f7018c21STomi Valkeinen pickup_default:
876f7018c21STomi Valkeinen /*
877f7018c21STomi Valkeinen * Apply passed-in mode option if any
878f7018c21STomi Valkeinen */
879f7018c21STomi Valkeinen if (mode_option) {
880f7018c21STomi Valkeinen if (fb_find_mode(&info->var, info, mode_option,
881f7018c21STomi Valkeinen info->monspecs.modedb,
882f7018c21STomi Valkeinen info->monspecs.modedb_len, NULL, 8) != 0)
883f7018c21STomi Valkeinen has_default_mode = 1;
884f7018c21STomi Valkeinen }
885f7018c21STomi Valkeinen
886f7018c21STomi Valkeinen #ifdef CONFIG_PPC_PSERIES
887f7018c21STomi Valkeinen if (!has_default_mode && (
888f7018c21STomi Valkeinen is_powerblade("IBM,8842") || /* JS20 */
889f7018c21STomi Valkeinen is_powerblade("IBM,8844") || /* JS21 */
890f7018c21STomi Valkeinen is_powerblade("IBM,7998") || /* JS12/JS21/JS22 */
891f7018c21STomi Valkeinen is_powerblade("IBM,0792") || /* QS21 */
892f7018c21STomi Valkeinen is_powerblade("IBM,0793") /* QS22 */
893f7018c21STomi Valkeinen )) {
894f7018c21STomi Valkeinen printk("Falling back to 800x600 on JSxx hardware\n");
895f7018c21STomi Valkeinen if (fb_find_mode(&info->var, info, "800x600@60",
896f7018c21STomi Valkeinen info->monspecs.modedb,
897f7018c21STomi Valkeinen info->monspecs.modedb_len, NULL, 8) != 0)
898f7018c21STomi Valkeinen has_default_mode = 1;
899f7018c21STomi Valkeinen }
900f7018c21STomi Valkeinen #endif
901f7018c21STomi Valkeinen
902f7018c21STomi Valkeinen /*
903f7018c21STomi Valkeinen * Still no mode, let's pick up a default from the db
904f7018c21STomi Valkeinen */
905f7018c21STomi Valkeinen if (!has_default_mode && info->monspecs.modedb != NULL) {
906f7018c21STomi Valkeinen struct fb_monspecs *specs = &info->monspecs;
907f7018c21STomi Valkeinen struct fb_videomode *modedb = NULL;
908f7018c21STomi Valkeinen
909f7018c21STomi Valkeinen /* get preferred timing */
910f7018c21STomi Valkeinen if (specs->misc & FB_MISC_1ST_DETAIL) {
911f7018c21STomi Valkeinen int i;
912f7018c21STomi Valkeinen
913f7018c21STomi Valkeinen for (i = 0; i < specs->modedb_len; i++) {
914f7018c21STomi Valkeinen if (specs->modedb[i].flag & FB_MODE_IS_FIRST) {
915f7018c21STomi Valkeinen modedb = &specs->modedb[i];
916f7018c21STomi Valkeinen break;
917f7018c21STomi Valkeinen }
918f7018c21STomi Valkeinen }
919f7018c21STomi Valkeinen } else {
920f7018c21STomi Valkeinen /* otherwise, get first mode in database */
921f7018c21STomi Valkeinen modedb = &specs->modedb[0];
922f7018c21STomi Valkeinen }
923f7018c21STomi Valkeinen if (modedb != NULL) {
924f7018c21STomi Valkeinen info->var.bits_per_pixel = 8;
925f7018c21STomi Valkeinen radeon_videomode_to_var(&info->var, modedb);
926f7018c21STomi Valkeinen has_default_mode = 1;
927f7018c21STomi Valkeinen }
928f7018c21STomi Valkeinen }
929f7018c21STomi Valkeinen if (1) {
930f7018c21STomi Valkeinen struct fb_videomode mode;
931f7018c21STomi Valkeinen /* Make sure that whatever mode got selected is actually in the
932f7018c21STomi Valkeinen * modelist or the kernel may die
933f7018c21STomi Valkeinen */
934f7018c21STomi Valkeinen fb_var_to_videomode(&mode, &info->var);
935f7018c21STomi Valkeinen fb_add_videomode(&mode, &info->modelist);
936f7018c21STomi Valkeinen }
937f7018c21STomi Valkeinen }
938f7018c21STomi Valkeinen
939f7018c21STomi Valkeinen /*
940f7018c21STomi Valkeinen * The code below is used to pick up a mode in check_var and
941f7018c21STomi Valkeinen * set_var. It should be made generic
942f7018c21STomi Valkeinen */
943f7018c21STomi Valkeinen
944f7018c21STomi Valkeinen /*
945f7018c21STomi Valkeinen * This is used when looking for modes. We assign a "distance" value
946f7018c21STomi Valkeinen * to a mode in the modedb depending how "close" it is from what we
947f7018c21STomi Valkeinen * are looking for.
948f7018c21STomi Valkeinen * Currently, we don't compare that much, we could do better but
949f7018c21STomi Valkeinen * the current fbcon doesn't quite mind ;)
950f7018c21STomi Valkeinen */
radeon_compare_modes(const struct fb_var_screeninfo * var,const struct fb_videomode * mode)951f7018c21STomi Valkeinen static int radeon_compare_modes(const struct fb_var_screeninfo *var,
952f7018c21STomi Valkeinen const struct fb_videomode *mode)
953f7018c21STomi Valkeinen {
954f7018c21STomi Valkeinen int distance = 0;
955f7018c21STomi Valkeinen
956f7018c21STomi Valkeinen distance = mode->yres - var->yres;
957f7018c21STomi Valkeinen distance += (mode->xres - var->xres)/2;
958f7018c21STomi Valkeinen return distance;
959f7018c21STomi Valkeinen }
960f7018c21STomi Valkeinen
961f7018c21STomi Valkeinen /*
962f7018c21STomi Valkeinen * This function is called by check_var, it gets the passed in mode parameter, and
963f7018c21STomi Valkeinen * outputs a valid mode matching the passed-in one as closely as possible.
964f7018c21STomi Valkeinen * We need something better ultimately. Things like fbcon basically pass us out
965f7018c21STomi Valkeinen * current mode with xres/yres hacked, while things like XFree will actually
966f7018c21STomi Valkeinen * produce a full timing that we should respect as much as possible.
967f7018c21STomi Valkeinen *
968f7018c21STomi Valkeinen * This is why I added the FB_ACTIVATE_FIND that is used by fbcon. Without this,
969f7018c21STomi Valkeinen * we do a simple spec match, that's all. With it, we actually look for a mode in
970f7018c21STomi Valkeinen * either our monitor modedb or the vesa one if none
971f7018c21STomi Valkeinen *
972f7018c21STomi Valkeinen */
radeon_match_mode(struct radeonfb_info * rinfo,struct fb_var_screeninfo * dest,const struct fb_var_screeninfo * src)973f7018c21STomi Valkeinen int radeon_match_mode(struct radeonfb_info *rinfo,
974f7018c21STomi Valkeinen struct fb_var_screeninfo *dest,
975f7018c21STomi Valkeinen const struct fb_var_screeninfo *src)
976f7018c21STomi Valkeinen {
977f7018c21STomi Valkeinen const struct fb_videomode *db = vesa_modes;
978f7018c21STomi Valkeinen int i, dbsize = 34;
979f7018c21STomi Valkeinen int has_rmx, native_db = 0;
980f7018c21STomi Valkeinen int distance = INT_MAX;
981f7018c21STomi Valkeinen const struct fb_videomode *candidate = NULL;
982f7018c21STomi Valkeinen
983f7018c21STomi Valkeinen /* Start with a copy of the requested mode */
984f7018c21STomi Valkeinen memcpy(dest, src, sizeof(struct fb_var_screeninfo));
985f7018c21STomi Valkeinen
986f7018c21STomi Valkeinen /* Check if we have a modedb built from EDID */
987f7018c21STomi Valkeinen if (rinfo->mon1_modedb) {
988f7018c21STomi Valkeinen db = rinfo->mon1_modedb;
989f7018c21STomi Valkeinen dbsize = rinfo->mon1_dbsize;
990f7018c21STomi Valkeinen native_db = 1;
991f7018c21STomi Valkeinen }
992f7018c21STomi Valkeinen
993f7018c21STomi Valkeinen /* Check if we have a scaler allowing any fancy mode */
994f7018c21STomi Valkeinen has_rmx = rinfo->mon1_type == MT_LCD || rinfo->mon1_type == MT_DFP;
995f7018c21STomi Valkeinen
996f7018c21STomi Valkeinen /* If we have a scaler and are passed FB_ACTIVATE_TEST or
997f7018c21STomi Valkeinen * FB_ACTIVATE_NOW, just do basic checking and return if the
998f7018c21STomi Valkeinen * mode match
999f7018c21STomi Valkeinen */
1000f7018c21STomi Valkeinen if ((src->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_TEST ||
1001f7018c21STomi Valkeinen (src->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
1002f7018c21STomi Valkeinen /* We don't have an RMX, validate timings. If we don't have
1003f7018c21STomi Valkeinen * monspecs, we should be paranoid and not let use go above
1004f7018c21STomi Valkeinen * 640x480-60, but I assume userland knows what it's doing here
1005f7018c21STomi Valkeinen * (though I may be proven wrong...)
1006f7018c21STomi Valkeinen */
1007f7018c21STomi Valkeinen if (has_rmx == 0 && rinfo->mon1_modedb)
1008f7018c21STomi Valkeinen if (fb_validate_mode((struct fb_var_screeninfo *)src, rinfo->info))
1009f7018c21STomi Valkeinen return -EINVAL;
1010f7018c21STomi Valkeinen return 0;
1011f7018c21STomi Valkeinen }
1012f7018c21STomi Valkeinen
1013f7018c21STomi Valkeinen /* Now look for a mode in the database */
1014f7018c21STomi Valkeinen while (db) {
1015f7018c21STomi Valkeinen for (i = 0; i < dbsize; i++) {
1016f7018c21STomi Valkeinen int d;
1017f7018c21STomi Valkeinen
1018f7018c21STomi Valkeinen if (db[i].yres < src->yres)
1019f7018c21STomi Valkeinen continue;
1020f7018c21STomi Valkeinen if (db[i].xres < src->xres)
1021f7018c21STomi Valkeinen continue;
1022f7018c21STomi Valkeinen d = radeon_compare_modes(src, &db[i]);
1023f7018c21STomi Valkeinen /* If the new mode is at least as good as the previous one,
1024f7018c21STomi Valkeinen * then it's our new candidate
1025f7018c21STomi Valkeinen */
1026f7018c21STomi Valkeinen if (d < distance) {
1027f7018c21STomi Valkeinen candidate = &db[i];
1028f7018c21STomi Valkeinen distance = d;
1029f7018c21STomi Valkeinen }
1030f7018c21STomi Valkeinen }
1031f7018c21STomi Valkeinen db = NULL;
1032f7018c21STomi Valkeinen /* If we have a scaler, we allow any mode from the database */
1033f7018c21STomi Valkeinen if (native_db && has_rmx) {
1034f7018c21STomi Valkeinen db = vesa_modes;
1035f7018c21STomi Valkeinen dbsize = 34;
1036f7018c21STomi Valkeinen native_db = 0;
1037f7018c21STomi Valkeinen }
1038f7018c21STomi Valkeinen }
1039f7018c21STomi Valkeinen
1040f7018c21STomi Valkeinen /* If we have found a match, return it */
1041f7018c21STomi Valkeinen if (candidate != NULL) {
1042f7018c21STomi Valkeinen radeon_videomode_to_var(dest, candidate);
1043f7018c21STomi Valkeinen return 0;
1044f7018c21STomi Valkeinen }
1045f7018c21STomi Valkeinen
1046f7018c21STomi Valkeinen /* If we haven't and don't have a scaler, fail */
1047f7018c21STomi Valkeinen if (!has_rmx)
1048f7018c21STomi Valkeinen return -EINVAL;
1049f7018c21STomi Valkeinen
1050f7018c21STomi Valkeinen return 0;
1051f7018c21STomi Valkeinen }
1052