?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Automatic merge of /spare/repo/netdev-2.6 branch ixgb
[linux-2.6.git] / drivers / video / aty / radeon_base.c
blobee25b9e8db60992fd8a6e6d041dc12fb49775a44
1 /*
2 * drivers/video/aty/radeon_base.c
3 *
4 * framebuffer driver for ATI Radeon chipset video boards
5 *
6 * Copyright 2003 Ben. Herrenschmidt <benh@kernel.crashing.org>
7 * Copyright 2000 Ani Joshi <ajoshi@kernel.crashing.org>
8 *
9 * i2c bits from Luca Tettamanti <kronos@kronoz.cjb.net>
10 *
11 * Special thanks to ATI DevRel team for their hardware donations.
12 *
13 * ...Insert GPL boilerplate here...
14 *
15 * Significant portions of this driver apdated from XFree86 Radeon
16 * driver which has the following copyright notice:
17 *
18 * Copyright 2000 ATI Technologies Inc., Markham, Ontario, and
19 * VA Linux Systems Inc., Fremont, California.
20 *
21 * All Rights Reserved.
22 *
23 * Permission is hereby granted, free of charge, to any person obtaining
24 * a copy of this software and associated documentation files (the
25 * "Software"), to deal in the Software without restriction, including
26 * without limitation on the rights to use, copy, modify, merge,
27 * publish, distribute, sublicense, and/or sell copies of the Software,
28 * and to permit persons to whom the Software is furnished to do so,
29 * subject to the following conditions:
30 *
31 * The above copyright notice and this permission notice (including the
32 * next paragraph) shall be included in all copies or substantial
33 * portions of the Software.
34 *
35 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
36 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
37 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
38 * NON-INFRINGEMENT. IN NO EVENT SHALL ATI, VA LINUX SYSTEMS AND/OR
39 * THEIR SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
40 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
41 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
42 * DEALINGS IN THE SOFTWARE.
43 *
44 * XFree86 driver authors:
45 *
46 * Kevin E. Martin <martin@xfree86.org>
47 * Rickard E. Faith <faith@valinux.com>
48 * Alan Hourihane <alanh@fairlite.demon.co.uk>
49 *
50 */
51
52
53 #define RADEON_VERSION "0.2.0"
54
55 #include <linux/config.h>
56 #include <linux/module.h>
57 #include <linux/moduleparam.h>
58 #include <linux/kernel.h>
59 #include <linux/errno.h>
60 #include <linux/string.h>
61 #include <linux/mm.h>
62 #include <linux/tty.h>
63 #include <linux/slab.h>
64 #include <linux/delay.h>
65 #include <linux/time.h>
66 #include <linux/fb.h>
67 #include <linux/ioport.h>
68 #include <linux/init.h>
69 #include <linux/pci.h>
70 #include <linux/vmalloc.h>
71 #include <linux/device.h>
72 #include <linux/i2c.h>
73
74 #include <asm/io.h>
75 #include <asm/uaccess.h>
76
77 #ifdef CONFIG_PPC_OF
78
79 #include <asm/pci-bridge.h>
80 #include "../macmodes.h"
81
82 #ifdef CONFIG_PMAC_BACKLIGHT
83 #include <asm/backlight.h>
84 #endif
85
86 #ifdef CONFIG_BOOTX_TEXT
87 #include <asm/btext.h>
88 #endif
89
90 #endif /* CONFIG_PPC_OF */
91
92 #ifdef CONFIG_MTRR
93 #include <asm/mtrr.h>
94 #endif
95
96 #include <video/radeon.h>
97 #include <linux/radeonfb.h>
98
99 #include "../edid.h" // MOVE THAT TO include/video
100 #include "ati_ids.h"
101 #include "radeonfb.h"
102
103 #define MAX_MAPPED_VRAM (2048*2048*4)
104 #define MIN_MAPPED_VRAM (1024*768*1)
105
106 #define CHIP_DEF(id, family, flags) \
107 { PCI_VENDOR_ID_ATI, id, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (flags) | (CHIP_FAMILY_##family) }
108
109 static struct pci_device_id radeonfb_pci_table[] = {
110 /* Mobility M6 */
111 CHIP_DEF(PCI_CHIP_RADEON_LY, RV100, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
112 CHIP_DEF(PCI_CHIP_RADEON_LZ, RV100, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
113 /* Radeon VE/7000 */
114 CHIP_DEF(PCI_CHIP_RV100_QY, RV100, CHIP_HAS_CRTC2),
115 CHIP_DEF(PCI_CHIP_RV100_QZ, RV100, CHIP_HAS_CRTC2),
116 /* Radeon IGP320M (U1) */
117 CHIP_DEF(PCI_CHIP_RS100_4336, RS100, CHIP_HAS_CRTC2 | CHIP_IS_IGP | CHIP_IS_MOBILITY),
118 /* Radeon IGP320 (A3) */
119 CHIP_DEF(PCI_CHIP_RS100_4136, RS100, CHIP_HAS_CRTC2 | CHIP_IS_IGP),
120 /* IGP330M/340M/350M (U2) */
121 CHIP_DEF(PCI_CHIP_RS200_4337, RS200, CHIP_HAS_CRTC2 | CHIP_IS_IGP | CHIP_IS_MOBILITY),
122 /* IGP330/340/350 (A4) */
123 CHIP_DEF(PCI_CHIP_RS200_4137, RS200, CHIP_HAS_CRTC2 | CHIP_IS_IGP),
124 /* Mobility 7000 IGP */
125 CHIP_DEF(PCI_CHIP_RS250_4437, RS200, CHIP_HAS_CRTC2 | CHIP_IS_IGP | CHIP_IS_MOBILITY),
126 /* 7000 IGP (A4+) */
127 CHIP_DEF(PCI_CHIP_RS250_4237, RS200, CHIP_HAS_CRTC2 | CHIP_IS_IGP),
128 /* 8500 AIW */
129 CHIP_DEF(PCI_CHIP_R200_BB, R200, CHIP_HAS_CRTC2),
130 CHIP_DEF(PCI_CHIP_R200_BC, R200, CHIP_HAS_CRTC2),
131 /* 8700/8800 */
132 CHIP_DEF(PCI_CHIP_R200_QH, R200, CHIP_HAS_CRTC2),
133 /* 8500 */
134 CHIP_DEF(PCI_CHIP_R200_QL, R200, CHIP_HAS_CRTC2),
135 /* 9100 */
136 CHIP_DEF(PCI_CHIP_R200_QM, R200, CHIP_HAS_CRTC2),
137 /* Mobility M7 */
138 CHIP_DEF(PCI_CHIP_RADEON_LW, RV200, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
139 CHIP_DEF(PCI_CHIP_RADEON_LX, RV200, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
140 /* 7500 */
141 CHIP_DEF(PCI_CHIP_RV200_QW, RV200, CHIP_HAS_CRTC2),
142 CHIP_DEF(PCI_CHIP_RV200_QX, RV200, CHIP_HAS_CRTC2),
143 /* Mobility M9 */
144 CHIP_DEF(PCI_CHIP_RV250_Ld, RV250, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
145 CHIP_DEF(PCI_CHIP_RV250_Le, RV250, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
146 CHIP_DEF(PCI_CHIP_RV250_Lf, RV250, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
147 CHIP_DEF(PCI_CHIP_RV250_Lg, RV250, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
148 /* 9000/Pro */
149 CHIP_DEF(PCI_CHIP_RV250_If, RV250, CHIP_HAS_CRTC2),
150 CHIP_DEF(PCI_CHIP_RV250_Ig, RV250, CHIP_HAS_CRTC2),
151 /* Mobility 9100 IGP (U3) */
152 CHIP_DEF(PCI_CHIP_RS300_5835, RS300, CHIP_HAS_CRTC2 | CHIP_IS_IGP | CHIP_IS_MOBILITY),
153 CHIP_DEF(PCI_CHIP_RS350_7835, RS300, CHIP_HAS_CRTC2 | CHIP_IS_IGP | CHIP_IS_MOBILITY),
154 /* 9100 IGP (A5) */
155 CHIP_DEF(PCI_CHIP_RS300_5834, RS300, CHIP_HAS_CRTC2 | CHIP_IS_IGP),
156 CHIP_DEF(PCI_CHIP_RS350_7834, RS300, CHIP_HAS_CRTC2 | CHIP_IS_IGP),
157 /* Mobility 9200 (M9+) */
158 CHIP_DEF(PCI_CHIP_RV280_5C61, RV280, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
159 CHIP_DEF(PCI_CHIP_RV280_5C63, RV280, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
160 /* 9200 */
161 CHIP_DEF(PCI_CHIP_RV280_5960, RV280, CHIP_HAS_CRTC2),
162 CHIP_DEF(PCI_CHIP_RV280_5961, RV280, CHIP_HAS_CRTC2),
163 CHIP_DEF(PCI_CHIP_RV280_5962, RV280, CHIP_HAS_CRTC2),
164 CHIP_DEF(PCI_CHIP_RV280_5964, RV280, CHIP_HAS_CRTC2),
165 /* 9500 */
166 CHIP_DEF(PCI_CHIP_R300_AD, R300, CHIP_HAS_CRTC2),
167 CHIP_DEF(PCI_CHIP_R300_AE, R300, CHIP_HAS_CRTC2),
168 /* 9600TX / FireGL Z1 */
169 CHIP_DEF(PCI_CHIP_R300_AF, R300, CHIP_HAS_CRTC2),
170 CHIP_DEF(PCI_CHIP_R300_AG, R300, CHIP_HAS_CRTC2),
171 /* 9700/9500/Pro/FireGL X1 */
172 CHIP_DEF(PCI_CHIP_R300_ND, R300, CHIP_HAS_CRTC2),
173 CHIP_DEF(PCI_CHIP_R300_NE, R300, CHIP_HAS_CRTC2),
174 CHIP_DEF(PCI_CHIP_R300_NF, R300, CHIP_HAS_CRTC2),
175 CHIP_DEF(PCI_CHIP_R300_NG, R300, CHIP_HAS_CRTC2),
176 /* Mobility M10/M11 */
177 CHIP_DEF(PCI_CHIP_RV350_NP, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
178 CHIP_DEF(PCI_CHIP_RV350_NQ, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
179 CHIP_DEF(PCI_CHIP_RV350_NR, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
180 CHIP_DEF(PCI_CHIP_RV350_NS, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
181 CHIP_DEF(PCI_CHIP_RV350_NT, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
182 CHIP_DEF(PCI_CHIP_RV350_NV, RV350, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
183 /* 9600/FireGL T2 */
184 CHIP_DEF(PCI_CHIP_RV350_AP, RV350, CHIP_HAS_CRTC2),
185 CHIP_DEF(PCI_CHIP_RV350_AQ, RV350, CHIP_HAS_CRTC2),
186 CHIP_DEF(PCI_CHIP_RV360_AR, RV350, CHIP_HAS_CRTC2),
187 CHIP_DEF(PCI_CHIP_RV350_AS, RV350, CHIP_HAS_CRTC2),
188 CHIP_DEF(PCI_CHIP_RV350_AT, RV350, CHIP_HAS_CRTC2),
189 CHIP_DEF(PCI_CHIP_RV350_AV, RV350, CHIP_HAS_CRTC2),
190 /* 9800/Pro/FileGL X2 */
191 CHIP_DEF(PCI_CHIP_R350_AH, R350, CHIP_HAS_CRTC2),
192 CHIP_DEF(PCI_CHIP_R350_AI, R350, CHIP_HAS_CRTC2),
193 CHIP_DEF(PCI_CHIP_R350_AJ, R350, CHIP_HAS_CRTC2),
194 CHIP_DEF(PCI_CHIP_R350_AK, R350, CHIP_HAS_CRTC2),
195 CHIP_DEF(PCI_CHIP_R350_NH, R350, CHIP_HAS_CRTC2),
196 CHIP_DEF(PCI_CHIP_R350_NI, R350, CHIP_HAS_CRTC2),
197 CHIP_DEF(PCI_CHIP_R360_NJ, R350, CHIP_HAS_CRTC2),
198 CHIP_DEF(PCI_CHIP_R350_NK, R350, CHIP_HAS_CRTC2),
199 /* Newer stuff */
200 CHIP_DEF(PCI_CHIP_RV380_3E50, RV380, CHIP_HAS_CRTC2),
201 CHIP_DEF(PCI_CHIP_RV380_3E54, RV380, CHIP_HAS_CRTC2),
202 CHIP_DEF(PCI_CHIP_RV380_3150, RV380, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
203 CHIP_DEF(PCI_CHIP_RV380_3154, RV380, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
204 CHIP_DEF(PCI_CHIP_RV370_5B60, RV380, CHIP_HAS_CRTC2),
205 CHIP_DEF(PCI_CHIP_RV370_5B62, RV380, CHIP_HAS_CRTC2),
206 CHIP_DEF(PCI_CHIP_RV370_5B64, RV380, CHIP_HAS_CRTC2),
207 CHIP_DEF(PCI_CHIP_RV370_5B65, RV380, CHIP_HAS_CRTC2),
208 CHIP_DEF(PCI_CHIP_RV370_5460, RV380, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
209 CHIP_DEF(PCI_CHIP_RV370_5464, RV380, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
210 CHIP_DEF(PCI_CHIP_R420_JH, R420, CHIP_HAS_CRTC2),
211 CHIP_DEF(PCI_CHIP_R420_JI, R420, CHIP_HAS_CRTC2),
212 CHIP_DEF(PCI_CHIP_R420_JJ, R420, CHIP_HAS_CRTC2),
213 CHIP_DEF(PCI_CHIP_R420_JK, R420, CHIP_HAS_CRTC2),
214 CHIP_DEF(PCI_CHIP_R420_JL, R420, CHIP_HAS_CRTC2),
215 CHIP_DEF(PCI_CHIP_R420_JM, R420, CHIP_HAS_CRTC2),
216 CHIP_DEF(PCI_CHIP_R420_JN, R420, CHIP_HAS_CRTC2 | CHIP_IS_MOBILITY),
217 CHIP_DEF(PCI_CHIP_R420_JP, R420, CHIP_HAS_CRTC2),
218 CHIP_DEF(PCI_CHIP_R423_UH, R420, CHIP_HAS_CRTC2),
219 CHIP_DEF(PCI_CHIP_R423_UI, R420, CHIP_HAS_CRTC2),
220 CHIP_DEF(PCI_CHIP_R423_UJ, R420, CHIP_HAS_CRTC2),
221 CHIP_DEF(PCI_CHIP_R423_UK, R420, CHIP_HAS_CRTC2),
222 CHIP_DEF(PCI_CHIP_R423_UQ, R420, CHIP_HAS_CRTC2),
223 CHIP_DEF(PCI_CHIP_R423_UR, R420, CHIP_HAS_CRTC2),
224 CHIP_DEF(PCI_CHIP_R423_UT, R420, CHIP_HAS_CRTC2),
225 CHIP_DEF(PCI_CHIP_R423_5D57, R420, CHIP_HAS_CRTC2),
226 /* Original Radeon/7200 */
227 CHIP_DEF(PCI_CHIP_RADEON_QD, RADEON, 0),
228 CHIP_DEF(PCI_CHIP_RADEON_QE, RADEON, 0),
229 CHIP_DEF(PCI_CHIP_RADEON_QF, RADEON, 0),
230 CHIP_DEF(PCI_CHIP_RADEON_QG, RADEON, 0),
231 { 0, }
232 };
233 MODULE_DEVICE_TABLE(pci, radeonfb_pci_table);
234
235
236 typedef struct {
237 u16 reg;
238 u32 val;
239 } reg_val;
240
241
242 /* these common regs are cleared before mode setting so they do not
243 * interfere with anything
244 */
245 static reg_val common_regs[] = {
246 { OVR_CLR, 0 },
247 { OVR_WID_LEFT_RIGHT, 0 },
248 { OVR_WID_TOP_BOTTOM, 0 },
249 { OV0_SCALE_CNTL, 0 },
250 { SUBPIC_CNTL, 0 },
251 { VIPH_CONTROL, 0 },
252 { I2C_CNTL_1, 0 },
253 { GEN_INT_CNTL, 0 },
254 { CAP0_TRIG_CNTL, 0 },
255 { CAP1_TRIG_CNTL, 0 },
256 };
257
258 /*
259 * globals
260 */
261
262 static char *mode_option;
263 static char *monitor_layout;
264 static int noaccel = 0;
265 static int default_dynclk = -2;
266 static int nomodeset = 0;
267 static int ignore_edid = 0;
268 static int mirror = 0;
269 static int panel_yres = 0;
270 static int force_dfp = 0;
271 static int force_measure_pll = 0;
272 #ifdef CONFIG_MTRR
273 static int nomtrr = 0;
274 #endif
275
276 /*
277 * prototypes
278 */
279
280
281 #ifdef CONFIG_PPC_OF
282
283 #ifdef CONFIG_PMAC_BACKLIGHT
284 static int radeon_set_backlight_enable(int on, int level, void *data);
285 static int radeon_set_backlight_level(int level, void *data);
286 static struct backlight_controller radeon_backlight_controller = {
287 radeon_set_backlight_enable,
288 radeon_set_backlight_level
289 };
290 #endif /* CONFIG_PMAC_BACKLIGHT */
291
292 #endif /* CONFIG_PPC_OF */
293
294 static void radeon_unmap_ROM(struct radeonfb_info *rinfo, struct pci_dev *dev)
295 {
296 if (!rinfo->bios_seg)
297 return;
298 pci_unmap_rom(dev, rinfo->bios_seg);
299 }
300
301 static int __devinit radeon_map_ROM(struct radeonfb_info *rinfo, struct pci_dev *dev)
302 {
303 void __iomem *rom;
304 u16 dptr;
305 u8 rom_type;
306 size_t rom_size;
307
308 /* If this is a primary card, there is a shadow copy of the
309 * ROM somewhere in the first meg. We will just ignore the copy
310 * and use the ROM directly.
311 */
312
313 /* Fix from ATI for problem with Radeon hardware not leaving ROM enabled */
314 unsigned int temp;
315 temp = INREG(MPP_TB_CONFIG);
316 temp &= 0x00ffffffu;
317 temp |= 0x04 << 24;
318 OUTREG(MPP_TB_CONFIG, temp);
319 temp = INREG(MPP_TB_CONFIG);
320
321 rom = pci_map_rom(dev, &rom_size);
322 if (!rom) {
323 printk(KERN_ERR "radeonfb (%s): ROM failed to map\n",
324 pci_name(rinfo->pdev));
325 return -ENOMEM;
326 }
327
328 rinfo->bios_seg = rom;
329
330 /* Very simple test to make sure it appeared */
331 if (BIOS_IN16(0) != 0xaa55) {
332 printk(KERN_ERR "radeonfb (%s): Invalid ROM signature %x should be"
333 "0xaa55\n", pci_name(rinfo->pdev), BIOS_IN16(0));
334 goto failed;
335 }
336 /* Look for the PCI data to check the ROM type */
337 dptr = BIOS_IN16(0x18);
338
339 /* Check the PCI data signature. If it's wrong, we still assume a normal x86 ROM
340 * for now, until I've verified this works everywhere. The goal here is more
341 * to phase out Open Firmware images.
342 *
343 * Currently, we only look at the first PCI data, we could iteratre and deal with
344 * them all, and we should use fb_bios_start relative to start of image and not
345 * relative start of ROM, but so far, I never found a dual-image ATI card
346 *
347 * typedef struct {
348 * u32 signature; + 0x00
349 * u16 vendor; + 0x04
350 * u16 device; + 0x06
351 * u16 reserved_1; + 0x08
352 * u16 dlen; + 0x0a
353 * u8 drevision; + 0x0c
354 * u8 class_hi; + 0x0d
355 * u16 class_lo; + 0x0e
356 * u16 ilen; + 0x10
357 * u16 irevision; + 0x12
358 * u8 type; + 0x14
359 * u8 indicator; + 0x15
360 * u16 reserved_2; + 0x16
361 * } pci_data_t;
362 */
363 if (BIOS_IN32(dptr) != (('R' << 24) | ('I' << 16) | ('C' << 8) | 'P')) {
364 printk(KERN_WARNING "radeonfb (%s): PCI DATA signature in ROM"
365 "incorrect: %08x\n", pci_name(rinfo->pdev), BIOS_IN32(dptr));
366 goto anyway;
367 }
368 rom_type = BIOS_IN8(dptr + 0x14);
369 switch(rom_type) {
370 case 0:
371 printk(KERN_INFO "radeonfb: Found Intel x86 BIOS ROM Image\n");
372 break;
373 case 1:
374 printk(KERN_INFO "radeonfb: Found Open Firmware ROM Image\n");
375 goto failed;
376 case 2:
377 printk(KERN_INFO "radeonfb: Found HP PA-RISC ROM Image\n");
378 goto failed;
379 default:
380 printk(KERN_INFO "radeonfb: Found unknown type %d ROM Image\n", rom_type);
381 goto failed;
382 }
383 anyway:
384 /* Locate the flat panel infos, do some sanity checking !!! */
385 rinfo->fp_bios_start = BIOS_IN16(0x48);
386 return 0;
387
388 failed:
389 rinfo->bios_seg = NULL;
390 radeon_unmap_ROM(rinfo, dev);
391 return -ENXIO;
392 }
393
394 #ifdef CONFIG_X86
395 static int __devinit radeon_find_mem_vbios(struct radeonfb_info *rinfo)
396 {
397 /* I simplified this code as we used to miss the signatures in
398 * a lot of case. It's now closer to XFree, we just don't check
399 * for signatures at all... Something better will have to be done
400 * if we end up having conflicts
401 */
402 u32 segstart;
403 void __iomem *rom_base = NULL;
404
405 for(segstart=0x000c0000; segstart<0x000f0000; segstart+=0x00001000) {
406 rom_base = ioremap(segstart, 0x10000);
407 if (rom_base == NULL)
408 return -ENOMEM;
409 if (readb(rom_base) == 0x55 && readb(rom_base + 1) == 0xaa)
410 break;
411 iounmap(rom_base);
412 rom_base = NULL;
413 }
414 if (rom_base == NULL)
415 return -ENXIO;
416
417 /* Locate the flat panel infos, do some sanity checking !!! */
418 rinfo->bios_seg = rom_base;
419 rinfo->fp_bios_start = BIOS_IN16(0x48);
420
421 return 0;
422 }
423 #endif
424
425 #ifdef CONFIG_PPC_OF
426 /*
427 * Read XTAL (ref clock), SCLK and MCLK from Open Firmware device
428 * tree. Hopefully, ATI OF driver is kind enough to fill these
429 */
430 static int __devinit radeon_read_xtal_OF (struct radeonfb_info *rinfo)
431 {
432 struct device_node *dp = rinfo->of_node;
433 u32 *val;
434
435 if (dp == NULL)
436 return -ENODEV;
437 val = (u32 *) get_property(dp, "ATY,RefCLK", NULL);
438 if (!val || !*val) {
439 printk(KERN_WARNING "radeonfb: No ATY,RefCLK property !\n");
440 return -EINVAL;
441 }
442
443 rinfo->pll.ref_clk = (*val) / 10;
444
445 val = (u32 *) get_property(dp, "ATY,SCLK", NULL);
446 if (val && *val)
447 rinfo->pll.sclk = (*val) / 10;
448
449 val = (u32 *) get_property(dp, "ATY,MCLK", NULL);
450 if (val && *val)
451 rinfo->pll.mclk = (*val) / 10;
452
453 return 0;
454 }
455 #endif /* CONFIG_PPC_OF */
456
457 /*
458 * Read PLL infos from chip registers
459 */
460 static int __devinit radeon_probe_pll_params(struct radeonfb_info *rinfo)
461 {
462 unsigned char ppll_div_sel;
463 unsigned Ns, Nm, M;
464 unsigned sclk, mclk, tmp, ref_div;
465 int hTotal, vTotal, num, denom, m, n;
466 unsigned long long hz, vclk;
467 long xtal;
468 struct timeval start_tv, stop_tv;
469 long total_secs, total_usecs;
470 int i;
471
472 /* Ugh, we cut interrupts, bad bad bad, but we want some precision
473 * here, so... --BenH
474 */
475
476 /* Flush PCI buffers ? */
477 tmp = INREG(DEVICE_ID);
478
479 local_irq_disable();
480
481 for(i=0; i<1000000; i++)
482 if (((INREG(CRTC_VLINE_CRNT_VLINE) >> 16) & 0x3ff) == 0)
483 break;
484
485 do_gettimeofday(&start_tv);
486
487 for(i=0; i<1000000; i++)
488 if (((INREG(CRTC_VLINE_CRNT_VLINE) >> 16) & 0x3ff) != 0)
489 break;
490
491 for(i=0; i<1000000; i++)
492 if (((INREG(CRTC_VLINE_CRNT_VLINE) >> 16) & 0x3ff) == 0)
493 break;
494
495 do_gettimeofday(&stop_tv);
496
497 local_irq_enable();
498
499 total_secs = stop_tv.tv_sec - start_tv.tv_sec;
500 if (total_secs > 10)
501 return -1;
502 total_usecs = stop_tv.tv_usec - start_tv.tv_usec;
503 total_usecs += total_secs * 1000000;
504 if (total_usecs < 0)
505 total_usecs = -total_usecs;
506 hz = 1000000/total_usecs;
507
508 hTotal = ((INREG(CRTC_H_TOTAL_DISP) & 0x1ff) + 1) * 8;
509 vTotal = ((INREG(CRTC_V_TOTAL_DISP) & 0x3ff) + 1);
510 vclk = (long long)hTotal * (long long)vTotal * hz;
511
512 switch((INPLL(PPLL_REF_DIV) & 0x30000) >> 16) {
513 case 0:
514 default:
515 num = 1;
516 denom = 1;
517 break;
518 case 1:
519 n = ((INPLL(M_SPLL_REF_FB_DIV) >> 16) & 0xff);
520 m = (INPLL(M_SPLL_REF_FB_DIV) & 0xff);
521 num = 2*n;
522 denom = 2*m;
523 break;
524 case 2:
525 n = ((INPLL(M_SPLL_REF_FB_DIV) >> 8) & 0xff);
526 m = (INPLL(M_SPLL_REF_FB_DIV) & 0xff);
527 num = 2*n;
528 denom = 2*m;
529 break;
530 }
531
532 ppll_div_sel = INREG8(CLOCK_CNTL_INDEX + 1) & 0x3;
533 radeon_pll_errata_after_index(rinfo);
534
535 n = (INPLL(PPLL_DIV_0 + ppll_div_sel) & 0x7ff);
536 m = (INPLL(PPLL_REF_DIV) & 0x3ff);
537
538 num *= n;
539 denom *= m;
540
541 switch ((INPLL(PPLL_DIV_0 + ppll_div_sel) >> 16) & 0x7) {
542 case 1:
543 denom *= 2;
544 break;
545 case 2:
546 denom *= 4;
547 break;
548 case 3:
549 denom *= 8;
550 break;
551 case 4:
552 denom *= 3;
553 break;
554 case 6:
555 denom *= 6;
556 break;
557 case 7:
558 denom *= 12;
559 break;
560 }
561
562 vclk *= denom;
563 do_div(vclk, 1000 * num);
564 xtal = vclk;
565
566 if ((xtal > 26900) && (xtal < 27100))
567 xtal = 2700;
568 else if ((xtal > 14200) && (xtal < 14400))
569 xtal = 1432;
570 else if ((xtal > 29400) && (xtal < 29600))
571 xtal = 2950;
572 else {
573 printk(KERN_WARNING "xtal calculation failed: %ld\n", xtal);
574 return -1;
575 }
576
577 tmp = INPLL(M_SPLL_REF_FB_DIV);
578 ref_div = INPLL(PPLL_REF_DIV) & 0x3ff;
579
580 Ns = (tmp & 0xff0000) >> 16;
581 Nm = (tmp & 0xff00) >> 8;
582 M = (tmp & 0xff);
583 sclk = round_div((2 * Ns * xtal), (2 * M));
584 mclk = round_div((2 * Nm * xtal), (2 * M));
585
586 /* we're done, hopefully these are sane values */
587 rinfo->pll.ref_clk = xtal;
588 rinfo->pll.ref_div = ref_div;
589 rinfo->pll.sclk = sclk;
590 rinfo->pll.mclk = mclk;
591
592 return 0;
593 }
594
595 /*
596 * Retreive PLL infos by different means (BIOS, Open Firmware, register probing...)
597 */
598 static void __devinit radeon_get_pllinfo(struct radeonfb_info *rinfo)
599 {
600 /*
601 * In the case nothing works, these are defaults; they are mostly
602 * incomplete, however. It does provide ppll_max and _min values
603 * even for most other methods, however.
604 */
605 switch (rinfo->chipset) {
606 case PCI_DEVICE_ID_ATI_RADEON_QW:
607 case PCI_DEVICE_ID_ATI_RADEON_QX:
608 rinfo->pll.ppll_max = 35000;
609 rinfo->pll.ppll_min = 12000;
610 rinfo->pll.mclk = 23000;
611 rinfo->pll.sclk = 23000;
612 rinfo->pll.ref_clk = 2700;
613 break;
614 case PCI_DEVICE_ID_ATI_RADEON_QL:
615 case PCI_DEVICE_ID_ATI_RADEON_QN:
616 case PCI_DEVICE_ID_ATI_RADEON_QO:
617 case PCI_DEVICE_ID_ATI_RADEON_Ql:
618 case PCI_DEVICE_ID_ATI_RADEON_BB:
619 rinfo->pll.ppll_max = 35000;
620 rinfo->pll.ppll_min = 12000;
621 rinfo->pll.mclk = 27500;
622 rinfo->pll.sclk = 27500;
623 rinfo->pll.ref_clk = 2700;
624 break;
625 case PCI_DEVICE_ID_ATI_RADEON_Id:
626 case PCI_DEVICE_ID_ATI_RADEON_Ie:
627 case PCI_DEVICE_ID_ATI_RADEON_If:
628 case PCI_DEVICE_ID_ATI_RADEON_Ig:
629 rinfo->pll.ppll_max = 35000;
630 rinfo->pll.ppll_min = 12000;
631 rinfo->pll.mclk = 25000;
632 rinfo->pll.sclk = 25000;
633 rinfo->pll.ref_clk = 2700;
634 break;
635 case PCI_DEVICE_ID_ATI_RADEON_ND:
636 case PCI_DEVICE_ID_ATI_RADEON_NE:
637 case PCI_DEVICE_ID_ATI_RADEON_NF:
638 case PCI_DEVICE_ID_ATI_RADEON_NG:
639 rinfo->pll.ppll_max = 40000;
640 rinfo->pll.ppll_min = 20000;
641 rinfo->pll.mclk = 27000;
642 rinfo->pll.sclk = 27000;
643 rinfo->pll.ref_clk = 2700;
644 break;
645 case PCI_DEVICE_ID_ATI_RADEON_QD:
646 case PCI_DEVICE_ID_ATI_RADEON_QE:
647 case PCI_DEVICE_ID_ATI_RADEON_QF:
648 case PCI_DEVICE_ID_ATI_RADEON_QG:
649 default:
650 rinfo->pll.ppll_max = 35000;
651 rinfo->pll.ppll_min = 12000;
652 rinfo->pll.mclk = 16600;
653 rinfo->pll.sclk = 16600;
654 rinfo->pll.ref_clk = 2700;
655 break;
656 }
657 rinfo->pll.ref_div = INPLL(PPLL_REF_DIV) & PPLL_REF_DIV_MASK;
658
659
660 #ifdef CONFIG_PPC_OF
661 /*
662 * Retreive PLL infos from Open Firmware first
663 */
664 if (!force_measure_pll && radeon_read_xtal_OF(rinfo) == 0) {
665 printk(KERN_INFO "radeonfb: Retreived PLL infos from Open Firmware\n");
666 goto found;
667 }
668 #endif /* CONFIG_PPC_OF */
669
670 /*
671 * Check out if we have an X86 which gave us some PLL informations
672 * and if yes, retreive them
673 */
674 if (!force_measure_pll && rinfo->bios_seg) {
675 u16 pll_info_block = BIOS_IN16(rinfo->fp_bios_start + 0x30);
676
677 rinfo->pll.sclk = BIOS_IN16(pll_info_block + 0x08);
678 rinfo->pll.mclk = BIOS_IN16(pll_info_block + 0x0a);
679 rinfo->pll.ref_clk = BIOS_IN16(pll_info_block + 0x0e);
680 rinfo->pll.ref_div = BIOS_IN16(pll_info_block + 0x10);
681 rinfo->pll.ppll_min = BIOS_IN32(pll_info_block + 0x12);
682 rinfo->pll.ppll_max = BIOS_IN32(pll_info_block + 0x16);
683
684 printk(KERN_INFO "radeonfb: Retreived PLL infos from BIOS\n");
685 goto found;
686 }
687
688 /*
689 * We didn't get PLL parameters from either OF or BIOS, we try to
690 * probe them
691 */
692 if (radeon_probe_pll_params(rinfo) == 0) {
693 printk(KERN_INFO "radeonfb: Retreived PLL infos from registers\n");
694 goto found;
695 }
696
697 /*
698 * Fall back to already-set defaults...
699 */
700 printk(KERN_INFO "radeonfb: Used default PLL infos\n");
701
702 found:
703 /*
704 * Some methods fail to retreive SCLK and MCLK values, we apply default
705 * settings in this case (200Mhz). If that really happne often, we could
706 * fetch from registers instead...
707 */
708 if (rinfo->pll.mclk == 0)
709 rinfo->pll.mclk = 20000;
710 if (rinfo->pll.sclk == 0)
711 rinfo->pll.sclk = 20000;
712
713 printk("radeonfb: Reference=%d.%02d MHz (RefDiv=%d) Memory=%d.%02d Mhz, System=%d.%02d MHz\n",
714 rinfo->pll.ref_clk / 100, rinfo->pll.ref_clk % 100,
715 rinfo->pll.ref_div,
716 rinfo->pll.mclk / 100, rinfo->pll.mclk % 100,
717 rinfo->pll.sclk / 100, rinfo->pll.sclk % 100);
718 printk("radeonfb: PLL min %d max %d\n", rinfo->pll.ppll_min, rinfo->pll.ppll_max);
719 }
720
721 static int radeonfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info)
722 {
723 struct radeonfb_info *rinfo = info->par;
724 struct fb_var_screeninfo v;
725 int nom, den;
726 unsigned int pitch;
727
728 if (radeon_match_mode(rinfo, &v, var))
729 return -EINVAL;
730
731 switch (v.bits_per_pixel) {
732 case 0 ... 8:
733 v.bits_per_pixel = 8;
734 break;
735 case 9 ... 16:
736 v.bits_per_pixel = 16;
737 break;
738 case 17 ... 24:
739 #if 0 /* Doesn't seem to work */
740 v.bits_per_pixel = 24;
741 break;
742 #endif
743 return -EINVAL;
744 case 25 ... 32:
745 v.bits_per_pixel = 32;
746 break;
747 default:
748 return -EINVAL;
749 }
750
751 switch (var_to_depth(&v)) {
752 case 8:
753 nom = den = 1;
754 v.red.offset = v.green.offset = v.blue.offset = 0;
755 v.red.length = v.green.length = v.blue.length = 8;
756 v.transp.offset = v.transp.length = 0;
757 break;
758 case 15:
759 nom = 2;
760 den = 1;
761 v.red.offset = 10;
762 v.green.offset = 5;
763 v.blue.offset = 0;
764 v.red.length = v.green.length = v.blue.length = 5;
765 v.transp.offset = v.transp.length = 0;
766 break;
767 case 16:
768 nom = 2;
769 den = 1;
770 v.red.offset = 11;
771 v.green.offset = 5;
772 v.blue.offset = 0;
773 v.red.length = 5;
774 v.green.length = 6;
775 v.blue.length = 5;
776 v.transp.offset = v.transp.length = 0;
777 break;
778 case 24:
779 nom = 4;
780 den = 1;
781 v.red.offset = 16;
782 v.green.offset = 8;
783 v.blue.offset = 0;
784 v.red.length = v.blue.length = v.green.length = 8;
785 v.transp.offset = v.transp.length = 0;
786 break;
787 case 32:
788 nom = 4;
789 den = 1;
790 v.red.offset = 16;
791 v.green.offset = 8;
792 v.blue.offset = 0;
793 v.red.length = v.blue.length = v.green.length = 8;
794 v.transp.offset = 24;
795 v.transp.length = 8;
796 break;
797 default:
798 printk ("radeonfb: mode %dx%dx%d rejected, color depth invalid\n",
799 var->xres, var->yres, var->bits_per_pixel);
800 return -EINVAL;
801 }
802
803 if (v.yres_virtual < v.yres)
804 v.yres_virtual = v.yres;
805 if (v.xres_virtual < v.xres)
806 v.xres_virtual = v.xres;
807
808
809 /* XXX I'm adjusting xres_virtual to the pitch, that may help XFree
810 * with some panels, though I don't quite like this solution
811 */
812 if (rinfo->info->flags & FBINFO_HWACCEL_DISABLED) {
813 v.xres_virtual = v.xres_virtual & ~7ul;
814 } else {
815 pitch = ((v.xres_virtual * ((v.bits_per_pixel + 1) / 8) + 0x3f)
816 & ~(0x3f)) >> 6;
817 v.xres_virtual = (pitch << 6) / ((v.bits_per_pixel + 1) / 8);
818 }
819
820 if (((v.xres_virtual * v.yres_virtual * nom) / den) > rinfo->mapped_vram)
821 return -EINVAL;
822
823 if (v.xres_virtual < v.xres)
824 v.xres = v.xres_virtual;
825
826 if (v.xoffset < 0)
827 v.xoffset = 0;
828 if (v.yoffset < 0)
829 v.yoffset = 0;
830
831 if (v.xoffset > v.xres_virtual - v.xres)
832 v.xoffset = v.xres_virtual - v.xres - 1;
833
834 if (v.yoffset > v.yres_virtual - v.yres)
835 v.yoffset = v.yres_virtual - v.yres - 1;
836
837 v.red.msb_right = v.green.msb_right = v.blue.msb_right =
838 v.transp.offset = v.transp.length =
839 v.transp.msb_right = 0;
840
841 memcpy(var, &v, sizeof(v));
842
843 return 0;
844 }
845
846
847 static int radeonfb_pan_display (struct fb_var_screeninfo *var,
848 struct fb_info *info)
849 {
850 struct radeonfb_info *rinfo = info->par;
851
852 if ((var->xoffset + var->xres > var->xres_virtual)
853 || (var->yoffset + var->yres > var->yres_virtual))
854 return -EINVAL;
855
856 if (rinfo->asleep)
857 return 0;
858
859 radeon_fifo_wait(2);
860 OUTREG(CRTC_OFFSET, ((var->yoffset * var->xres_virtual + var->xoffset)
861 * var->bits_per_pixel / 8) & ~7);
862 return 0;
863 }
864
865
866 static int radeonfb_ioctl (struct inode *inode, struct file *file, unsigned int cmd,
867 unsigned long arg, struct fb_info *info)
868 {
869 struct radeonfb_info *rinfo = info->par;
870 unsigned int tmp;
871 u32 value = 0;
872 int rc;
873
874 switch (cmd) {
875 /*
876 * TODO: set mirror accordingly for non-Mobility chipsets with 2 CRTC's
877 * and do something better using 2nd CRTC instead of just hackish
878 * routing to second output
879 */
880 case FBIO_RADEON_SET_MIRROR:
881 if (!rinfo->is_mobility)
882 return -EINVAL;
883
884 rc = get_user(value, (__u32 __user *)arg);
885
886 if (rc)
887 return rc;
888
889 radeon_fifo_wait(2);
890 if (value & 0x01) {
891 tmp = INREG(LVDS_GEN_CNTL);
892
893 tmp |= (LVDS_ON | LVDS_BLON);
894 } else {
895 tmp = INREG(LVDS_GEN_CNTL);
896
897 tmp &= ~(LVDS_ON | LVDS_BLON);
898 }
899
900 OUTREG(LVDS_GEN_CNTL, tmp);
901
902 if (value & 0x02) {
903 tmp = INREG(CRTC_EXT_CNTL);
904 tmp |= CRTC_CRT_ON;
905
906 mirror = 1;
907 } else {
908 tmp = INREG(CRTC_EXT_CNTL);
909 tmp &= ~CRTC_CRT_ON;
910
911 mirror = 0;
912 }
913
914 OUTREG(CRTC_EXT_CNTL, tmp);
915
916 return 0;
917 case FBIO_RADEON_GET_MIRROR:
918 if (!rinfo->is_mobility)
919 return -EINVAL;
920
921 tmp = INREG(LVDS_GEN_CNTL);
922 if ((LVDS_ON | LVDS_BLON) & tmp)
923 value |= 0x01;
924
925 tmp = INREG(CRTC_EXT_CNTL);
926 if (CRTC_CRT_ON & tmp)
927 value |= 0x02;
928
929 return put_user(value, (__u32 __user *)arg);
930 default:
931 return -EINVAL;
932 }
933
934 return -EINVAL;
935 }
936
937
938 int radeon_screen_blank(struct radeonfb_info *rinfo, int blank, int mode_switch)
939 {
940 u32 val;
941 u32 tmp_pix_clks;
942 int unblank = 0;
943
944 if (rinfo->lock_blank)
945 return 0;
946
947 radeon_engine_idle();
948
949 val = INREG(CRTC_EXT_CNTL);
950 val &= ~(CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS |
951 CRTC_VSYNC_DIS);
952 switch (blank) {
953 case FB_BLANK_VSYNC_SUSPEND:
954 val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS);
955 break;
956 case FB_BLANK_HSYNC_SUSPEND:
957 val |= (CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS);
958 break;
959 case FB_BLANK_POWERDOWN:
960 val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS |
961 CRTC_HSYNC_DIS);
962 break;
963 case FB_BLANK_NORMAL:
964 val |= CRTC_DISPLAY_DIS;
965 break;
966 case FB_BLANK_UNBLANK:
967 default:
968 unblank = 1;
969 }
970 OUTREG(CRTC_EXT_CNTL, val);
971
972
973 switch (rinfo->mon1_type) {
974 case MT_DFP:
975 if (unblank)
976 OUTREGP(FP_GEN_CNTL, (FP_FPON | FP_TMDS_EN),
977 ~(FP_FPON | FP_TMDS_EN));
978 else {
979 if (mode_switch || blank == FB_BLANK_NORMAL)
980 break;
981 OUTREGP(FP_GEN_CNTL, 0, ~(FP_FPON | FP_TMDS_EN));
982 }
983 break;
984 case MT_LCD:
985 del_timer_sync(&rinfo->lvds_timer);
986 val = INREG(LVDS_GEN_CNTL);
987 if (unblank) {
988 u32 target_val = (val & ~LVDS_DISPLAY_DIS) | LVDS_BLON | LVDS_ON
989 | LVDS_EN | (rinfo->init_state.lvds_gen_cntl
990 & (LVDS_DIGON | LVDS_BL_MOD_EN));
991 if ((val ^ target_val) == LVDS_DISPLAY_DIS)
992 OUTREG(LVDS_GEN_CNTL, target_val);
993 else if ((val ^ target_val) != 0) {
994 OUTREG(LVDS_GEN_CNTL, target_val
995 & ~(LVDS_ON | LVDS_BL_MOD_EN));
996 rinfo->init_state.lvds_gen_cntl &= ~LVDS_STATE_MASK;
997 rinfo->init_state.lvds_gen_cntl |=
998 target_val & LVDS_STATE_MASK;
999 if (mode_switch) {
1000 radeon_msleep(rinfo->panel_info.pwr_delay);
1001 OUTREG(LVDS_GEN_CNTL, target_val);
1002 }
1003 else {
1004 rinfo->pending_lvds_gen_cntl = target_val;
1005 mod_timer(&rinfo->lvds_timer,
1006 jiffies +
1007 msecs_to_jiffies(rinfo->panel_info.pwr_delay));
1008 }
1009 }
1010 } else {
1011 val |= LVDS_DISPLAY_DIS;
1012 OUTREG(LVDS_GEN_CNTL, val);
1013
1014 /* We don't do a full switch-off on a simple mode switch */
1015 if (mode_switch || blank == FB_BLANK_NORMAL)
1016 break;
1017
1018 /* Asic bug, when turning off LVDS_ON, we have to make sure
1019 * RADEON_PIXCLK_LVDS_ALWAYS_ON bit is off
1020 */
1021 tmp_pix_clks = INPLL(PIXCLKS_CNTL);
1022 if (rinfo->is_mobility || rinfo->is_IGP)
1023 OUTPLLP(PIXCLKS_CNTL, 0, ~PIXCLK_LVDS_ALWAYS_ONb);
1024 val &= ~(LVDS_BL_MOD_EN);
1025 OUTREG(LVDS_GEN_CNTL, val);
1026 udelay(100);
1027 val &= ~(LVDS_ON | LVDS_EN);
1028 OUTREG(LVDS_GEN_CNTL, val);
1029 val &= ~LVDS_DIGON;
1030 rinfo->pending_lvds_gen_cntl = val;
1031 mod_timer(&rinfo->lvds_timer,
1032 jiffies +
1033 msecs_to_jiffies(rinfo->panel_info.pwr_delay));
1034 rinfo->init_state.lvds_gen_cntl &= ~LVDS_STATE_MASK;
1035 rinfo->init_state.lvds_gen_cntl |= val & LVDS_STATE_MASK;
1036 if (rinfo->is_mobility || rinfo->is_IGP)
1037 OUTPLL(PIXCLKS_CNTL, tmp_pix_clks);
1038 }
1039 break;
1040 case MT_CRT:
1041 // todo: powerdown DAC
1042 default:
1043 break;
1044 }
1045
1046 /* let fbcon do a soft blank for us */
1047 return (blank == FB_BLANK_NORMAL) ? -EINVAL : 0;
1048 }
1049
1050 static int radeonfb_blank (int blank, struct fb_info *info)
1051 {
1052 struct radeonfb_info *rinfo = info->par;
1053
1054 if (rinfo->asleep)
1055 return 0;
1056
1057 return radeon_screen_blank(rinfo, blank, 0);
1058 }
1059
1060 static int radeon_setcolreg (unsigned regno, unsigned red, unsigned green,
1061 unsigned blue, unsigned transp,
1062 struct radeonfb_info *rinfo)
1063 {
1064 u32 pindex;
1065 unsigned int i;
1066
1067
1068 if (regno > 255)
1069 return 1;
1070
1071 red >>= 8;
1072 green >>= 8;
1073 blue >>= 8;
1074 rinfo->palette[regno].red = red;
1075 rinfo->palette[regno].green = green;
1076 rinfo->palette[regno].blue = blue;
1077
1078 /* default */
1079 pindex = regno;
1080
1081 if (!rinfo->asleep) {
1082 radeon_fifo_wait(9);
1083
1084 if (rinfo->bpp == 16) {
1085 pindex = regno * 8;
1086
1087 if (rinfo->depth == 16 && regno > 63)
1088 return 1;
1089 if (rinfo->depth == 15 && regno > 31)
1090 return 1;
1091
1092 /* For 565, the green component is mixed one order
1093 * below
1094 */
1095 if (rinfo->depth == 16) {
1096 OUTREG(PALETTE_INDEX, pindex>>1);
1097 OUTREG(PALETTE_DATA,
1098 (rinfo->palette[regno>>1].red << 16) |
1099 (green << 8) |
1100 (rinfo->palette[regno>>1].blue));
1101 green = rinfo->palette[regno<<1].green;
1102 }
1103 }
1104
1105 if (rinfo->depth != 16 || regno < 32) {
1106 OUTREG(PALETTE_INDEX, pindex);
1107 OUTREG(PALETTE_DATA, (red << 16) |
1108 (green << 8) | blue);
1109 }
1110 }
1111 if (regno < 16) {
1112 u32 *pal = rinfo->info->pseudo_palette;
1113 switch (rinfo->depth) {
1114 case 15:
1115 pal[regno] = (regno << 10) | (regno << 5) | regno;
1116 break;
1117 case 16:
1118 pal[regno] = (regno << 11) | (regno << 5) | regno;
1119 break;
1120 case 24:
1121 pal[regno] = (regno << 16) | (regno << 8) | regno;
1122 break;
1123 case 32:
1124 i = (regno << 8) | regno;
1125 pal[regno] = (i << 16) | i;
1126 break;
1127 }
1128 }
1129 return 0;
1130 }
1131
1132 static int radeonfb_setcolreg (unsigned regno, unsigned red, unsigned green,
1133 unsigned blue, unsigned transp,
1134 struct fb_info *info)
1135 {
1136 struct radeonfb_info *rinfo = info->par;
1137 u32 dac_cntl2, vclk_cntl = 0;
1138 int rc;
1139
1140 if (!rinfo->asleep) {
1141 if (rinfo->is_mobility) {
1142 vclk_cntl = INPLL(VCLK_ECP_CNTL);
1143 OUTPLL(VCLK_ECP_CNTL,
1144 vclk_cntl & ~PIXCLK_DAC_ALWAYS_ONb);
1145 }
1146
1147 /* Make sure we are on first palette */
1148 if (rinfo->has_CRTC2) {
1149 dac_cntl2 = INREG(DAC_CNTL2);
1150 dac_cntl2 &= ~DAC2_PALETTE_ACCESS_CNTL;
1151 OUTREG(DAC_CNTL2, dac_cntl2);
1152 }
1153 }
1154
1155 rc = radeon_setcolreg (regno, red, green, blue, transp, rinfo);
1156
1157 if (!rinfo->asleep && rinfo->is_mobility)
1158 OUTPLL(VCLK_ECP_CNTL, vclk_cntl);
1159
1160 return rc;
1161 }
1162
1163 static int radeonfb_setcmap(struct fb_cmap *cmap, struct fb_info *info)
1164 {
1165 struct radeonfb_info *rinfo = info->par;
1166 u16 *red, *green, *blue, *transp;
1167 u32 dac_cntl2, vclk_cntl = 0;
1168 int i, start, rc = 0;
1169
1170 if (!rinfo->asleep) {
1171 if (rinfo->is_mobility) {
1172 vclk_cntl = INPLL(VCLK_ECP_CNTL);
1173 OUTPLL(VCLK_ECP_CNTL,
1174 vclk_cntl & ~PIXCLK_DAC_ALWAYS_ONb);
1175 }
1176
1177 /* Make sure we are on first palette */
1178 if (rinfo->has_CRTC2) {
1179 dac_cntl2 = INREG(DAC_CNTL2);
1180 dac_cntl2 &= ~DAC2_PALETTE_ACCESS_CNTL;
1181 OUTREG(DAC_CNTL2, dac_cntl2);
1182 }
1183 }
1184
1185 red = cmap->red;
1186 green = cmap->green;
1187 blue = cmap->blue;
1188 transp = cmap->transp;
1189 start = cmap->start;
1190
1191 for (i = 0; i < cmap->len; i++) {
1192 u_int hred, hgreen, hblue, htransp = 0xffff;
1193
1194 hred = *red++;
1195 hgreen = *green++;
1196 hblue = *blue++;
1197 if (transp)
1198 htransp = *transp++;
1199 rc = radeon_setcolreg (start++, hred, hgreen, hblue, htransp,
1200 rinfo);
1201 if (rc)
1202 break;
1203 }
1204
1205 if (!rinfo->asleep && rinfo->is_mobility)
1206 OUTPLL(VCLK_ECP_CNTL, vclk_cntl);
1207
1208 return rc;
1209 }
1210
1211 static void radeon_save_state (struct radeonfb_info *rinfo,
1212 struct radeon_regs *save)
1213 {
1214 /* CRTC regs */
1215 save->crtc_gen_cntl = INREG(CRTC_GEN_CNTL);
1216 save->crtc_ext_cntl = INREG(CRTC_EXT_CNTL);
1217 save->crtc_more_cntl = INREG(CRTC_MORE_CNTL);
1218 save->dac_cntl = INREG(DAC_CNTL);
1219 save->crtc_h_total_disp = INREG(CRTC_H_TOTAL_DISP);
1220 save->crtc_h_sync_strt_wid = INREG(CRTC_H_SYNC_STRT_WID);
1221 save->crtc_v_total_disp = INREG(CRTC_V_TOTAL_DISP);
1222 save->crtc_v_sync_strt_wid = INREG(CRTC_V_SYNC_STRT_WID);
1223 save->crtc_pitch = INREG(CRTC_PITCH);
1224 save->surface_cntl = INREG(SURFACE_CNTL);
1225
1226 /* FP regs */
1227 save->fp_crtc_h_total_disp = INREG(FP_CRTC_H_TOTAL_DISP);
1228 save->fp_crtc_v_total_disp = INREG(FP_CRTC_V_TOTAL_DISP);
1229 save->fp_gen_cntl = INREG(FP_GEN_CNTL);
1230 save->fp_h_sync_strt_wid = INREG(FP_H_SYNC_STRT_WID);
1231 save->fp_horz_stretch = INREG(FP_HORZ_STRETCH);
1232 save->fp_v_sync_strt_wid = INREG(FP_V_SYNC_STRT_WID);
1233 save->fp_vert_stretch = INREG(FP_VERT_STRETCH);
1234 save->lvds_gen_cntl = INREG(LVDS_GEN_CNTL);
1235 save->lvds_pll_cntl = INREG(LVDS_PLL_CNTL);
1236 save->tmds_crc = INREG(TMDS_CRC);
1237 save->tmds_transmitter_cntl = INREG(TMDS_TRANSMITTER_CNTL);
1238 save->vclk_ecp_cntl = INPLL(VCLK_ECP_CNTL);
1239
1240 /* PLL regs */
1241 save->clk_cntl_index = INREG(CLOCK_CNTL_INDEX) & ~0x3f;
1242 radeon_pll_errata_after_index(rinfo);
1243 save->ppll_div_3 = INPLL(PPLL_DIV_3);
1244 save->ppll_ref_div = INPLL(PPLL_REF_DIV);
1245 }
1246
1247
1248 static void radeon_write_pll_regs(struct radeonfb_info *rinfo, struct radeon_regs *mode)
1249 {
1250 int i;
1251
1252 radeon_fifo_wait(20);
1253
1254 /* Workaround from XFree */
1255 if (rinfo->is_mobility) {
1256 /* A temporal workaround for the occational blanking on certain laptop
1257 * panels. This appears to related to the PLL divider registers
1258 * (fail to lock?). It occurs even when all dividers are the same
1259 * with their old settings. In this case we really don't need to
1260 * fiddle with PLL registers. By doing this we can avoid the blanking
1261 * problem with some panels.
1262 */
1263 if ((mode->ppll_ref_div == (INPLL(PPLL_REF_DIV) & PPLL_REF_DIV_MASK)) &&
1264 (mode->ppll_div_3 == (INPLL(PPLL_DIV_3) &
1265 (PPLL_POST3_DIV_MASK | PPLL_FB3_DIV_MASK)))) {
1266 /* We still have to force a switch to selected PPLL div thanks to
1267 * an XFree86 driver bug which will switch it away in some cases
1268 * even when using UseFDev */
1269 OUTREGP(CLOCK_CNTL_INDEX,
1270 mode->clk_cntl_index & PPLL_DIV_SEL_MASK,
1271 ~PPLL_DIV_SEL_MASK);
1272 radeon_pll_errata_after_index(rinfo);
1273 radeon_pll_errata_after_data(rinfo);
1274 return;
1275 }
1276 }
1277
1278 /* Swich VCKL clock input to CPUCLK so it stays fed while PPLL updates*/
1279 OUTPLLP(VCLK_ECP_CNTL, VCLK_SRC_SEL_CPUCLK, ~VCLK_SRC_SEL_MASK);
1280
1281 /* Reset PPLL & enable atomic update */
1282 OUTPLLP(PPLL_CNTL,
1283 PPLL_RESET | PPLL_ATOMIC_UPDATE_EN | PPLL_VGA_ATOMIC_UPDATE_EN,
1284 ~(PPLL_RESET | PPLL_ATOMIC_UPDATE_EN | PPLL_VGA_ATOMIC_UPDATE_EN));
1285
1286 /* Switch to selected PPLL divider */
1287 OUTREGP(CLOCK_CNTL_INDEX,
1288 mode->clk_cntl_index & PPLL_DIV_SEL_MASK,
1289 ~PPLL_DIV_SEL_MASK);
1290 radeon_pll_errata_after_index(rinfo);
1291 radeon_pll_errata_after_data(rinfo);
1292
1293 /* Set PPLL ref. div */
1294 if (rinfo->family == CHIP_FAMILY_R300 ||
1295 rinfo->family == CHIP_FAMILY_RS300 ||
1296 rinfo->family == CHIP_FAMILY_R350 ||
1297 rinfo->family == CHIP_FAMILY_RV350) {
1298 if (mode->ppll_ref_div & R300_PPLL_REF_DIV_ACC_MASK) {
1299 /* When restoring console mode, use saved PPLL_REF_DIV
1300 * setting.
1301 */
1302 OUTPLLP(PPLL_REF_DIV, mode->ppll_ref_div, 0);
1303 } else {
1304 /* R300 uses ref_div_acc field as real ref divider */
1305 OUTPLLP(PPLL_REF_DIV,
1306 (mode->ppll_ref_div << R300_PPLL_REF_DIV_ACC_SHIFT),
1307 ~R300_PPLL_REF_DIV_ACC_MASK);
1308 }
1309 } else
1310 OUTPLLP(PPLL_REF_DIV, mode->ppll_ref_div, ~PPLL_REF_DIV_MASK);
1311
1312 /* Set PPLL divider 3 & post divider*/
1313 OUTPLLP(PPLL_DIV_3, mode->ppll_div_3, ~PPLL_FB3_DIV_MASK);
1314 OUTPLLP(PPLL_DIV_3, mode->ppll_div_3, ~PPLL_POST3_DIV_MASK);
1315
1316 /* Write update */
1317 while (INPLL(PPLL_REF_DIV) & PPLL_ATOMIC_UPDATE_R)
1318 ;
1319 OUTPLLP(PPLL_REF_DIV, PPLL_ATOMIC_UPDATE_W, ~PPLL_ATOMIC_UPDATE_W);
1320
1321 /* Wait read update complete */
1322 /* FIXME: Certain revisions of R300 can't recover here. Not sure of
1323 the cause yet, but this workaround will mask the problem for now.
1324 Other chips usually will pass at the very first test, so the
1325 workaround shouldn't have any effect on them. */
1326 for (i = 0; (i < 10000 && INPLL(PPLL_REF_DIV) & PPLL_ATOMIC_UPDATE_R); i++)
1327 ;
1328
1329 OUTPLL(HTOTAL_CNTL, 0);
1330
1331 /* Clear reset & atomic update */
1332 OUTPLLP(PPLL_CNTL, 0,
1333 ~(PPLL_RESET | PPLL_SLEEP | PPLL_ATOMIC_UPDATE_EN | PPLL_VGA_ATOMIC_UPDATE_EN));
1334
1335 /* We may want some locking ... oh well */
1336 radeon_msleep(5);
1337
1338 /* Switch back VCLK source to PPLL */
1339 OUTPLLP(VCLK_ECP_CNTL, VCLK_SRC_SEL_PPLLCLK, ~VCLK_SRC_SEL_MASK);
1340 }
1341
1342 /*
1343 * Timer function for delayed LVDS panel power up/down
1344 */
1345 static void radeon_lvds_timer_func(unsigned long data)
1346 {
1347 struct radeonfb_info *rinfo = (struct radeonfb_info *)data;
1348
1349 radeon_engine_idle();
1350
1351 OUTREG(LVDS_GEN_CNTL, rinfo->pending_lvds_gen_cntl);
1352 }
1353
1354 /*
1355 * Apply a video mode. This will apply the whole register set, including
1356 * the PLL registers, to the card
1357 */
1358 void radeon_write_mode (struct radeonfb_info *rinfo, struct radeon_regs *mode,
1359 int regs_only)
1360 {
1361 int i;
1362 int primary_mon = PRIMARY_MONITOR(rinfo);
1363
1364 if (nomodeset)
1365 return;
1366
1367 if (!regs_only)
1368 radeon_screen_blank(rinfo, FB_BLANK_NORMAL, 0);
1369
1370 radeon_fifo_wait(31);
1371 for (i=0; i<10; i++)
1372 OUTREG(common_regs[i].reg, common_regs[i].val);
1373
1374 /* Apply surface registers */
1375 for (i=0; i<8; i++) {
1376 OUTREG(SURFACE0_LOWER_BOUND + 0x10*i, mode->surf_lower_bound[i]);
1377 OUTREG(SURFACE0_UPPER_BOUND + 0x10*i, mode->surf_upper_bound[i]);
1378 OUTREG(SURFACE0_INFO + 0x10*i, mode->surf_info[i]);
1379 }
1380
1381 OUTREG(CRTC_GEN_CNTL, mode->crtc_gen_cntl);
1382 OUTREGP(CRTC_EXT_CNTL, mode->crtc_ext_cntl,
1383 ~(CRTC_HSYNC_DIS | CRTC_VSYNC_DIS | CRTC_DISPLAY_DIS));
1384 OUTREG(CRTC_MORE_CNTL, mode->crtc_more_cntl);
1385 OUTREGP(DAC_CNTL, mode->dac_cntl, DAC_RANGE_CNTL | DAC_BLANKING);
1386 OUTREG(CRTC_H_TOTAL_DISP, mode->crtc_h_total_disp);
1387 OUTREG(CRTC_H_SYNC_STRT_WID, mode->crtc_h_sync_strt_wid);
1388 OUTREG(CRTC_V_TOTAL_DISP, mode->crtc_v_total_disp);
1389 OUTREG(CRTC_V_SYNC_STRT_WID, mode->crtc_v_sync_strt_wid);
1390 OUTREG(CRTC_OFFSET, 0);
1391 OUTREG(CRTC_OFFSET_CNTL, 0);
1392 OUTREG(CRTC_PITCH, mode->crtc_pitch);
1393 OUTREG(SURFACE_CNTL, mode->surface_cntl);
1394
1395 radeon_write_pll_regs(rinfo, mode);
1396
1397 if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) {
1398 radeon_fifo_wait(10);
1399 OUTREG(FP_CRTC_H_TOTAL_DISP, mode->fp_crtc_h_total_disp);
1400 OUTREG(FP_CRTC_V_TOTAL_DISP, mode->fp_crtc_v_total_disp);
1401 OUTREG(FP_H_SYNC_STRT_WID, mode->fp_h_sync_strt_wid);
1402 OUTREG(FP_V_SYNC_STRT_WID, mode->fp_v_sync_strt_wid);
1403 OUTREG(FP_HORZ_STRETCH, mode->fp_horz_stretch);
1404 OUTREG(FP_VERT_STRETCH, mode->fp_vert_stretch);
1405 OUTREG(FP_GEN_CNTL, mode->fp_gen_cntl);
1406 OUTREG(TMDS_CRC, mode->tmds_crc);
1407 OUTREG(TMDS_TRANSMITTER_CNTL, mode->tmds_transmitter_cntl);
1408 }
1409
1410 if (!regs_only)
1411 radeon_screen_blank(rinfo, FB_BLANK_UNBLANK, 0);
1412
1413 radeon_fifo_wait(2);
1414 OUTPLL(VCLK_ECP_CNTL, mode->vclk_ecp_cntl);
1415
1416 return;
1417 }
1418
1419 /*
1420 * Calculate the PLL values for a given mode
1421 */
1422 static void radeon_calc_pll_regs(struct radeonfb_info *rinfo, struct radeon_regs *regs,
1423 unsigned long freq)
1424 {
1425 const struct {
1426 int divider;
1427 int bitvalue;
1428 } *post_div,
1429 post_divs[] = {
1430 { 1, 0 },
1431 { 2, 1 },
1432 { 4, 2 },
1433 { 8, 3 },
1434 { 3, 4 },
1435 { 16, 5 },
1436 { 6, 6 },
1437 { 12, 7 },
1438 { 0, 0 },
1439 };
1440 int fb_div, pll_output_freq = 0;
1441 int uses_dvo = 0;
1442
1443 /* Check if the DVO port is enabled and sourced from the primary CRTC. I'm
1444 * not sure which model starts having FP2_GEN_CNTL, I assume anything more
1445 * recent than an r(v)100...
1446 */
1447 #if 1
1448 /* XXX I had reports of flicker happening with the cinema display
1449 * on TMDS1 that seem to be fixed if I also forbit odd dividers in
1450 * this case. This could just be a bandwidth calculation issue, I
1451 * haven't implemented the bandwidth code yet, but in the meantime,
1452 * forcing uses_dvo to 1 fixes it and shouln't have bad side effects,
1453 * I haven't seen a case were were absolutely needed an odd PLL
1454 * divider. I'll find a better fix once I have more infos on the
1455 * real cause of the problem.
1456 */
1457 while (rinfo->has_CRTC2) {
1458 u32 fp2_gen_cntl = INREG(FP2_GEN_CNTL);
1459 u32 disp_output_cntl;
1460 int source;
1461
1462 /* FP2 path not enabled */
1463 if ((fp2_gen_cntl & FP2_ON) == 0)
1464 break;
1465 /* Not all chip revs have the same format for this register,
1466 * extract the source selection
1467 */
1468 if (rinfo->family == CHIP_FAMILY_R200 ||
1469 rinfo->family == CHIP_FAMILY_R300 ||
1470 rinfo->family == CHIP_FAMILY_R350 ||
1471 rinfo->family == CHIP_FAMILY_RV350) {
1472 source = (fp2_gen_cntl >> 10) & 0x3;
1473 /* sourced from transform unit, check for transform unit
1474 * own source
1475 */
1476 if (source == 3) {
1477 disp_output_cntl = INREG(DISP_OUTPUT_CNTL);
1478 source = (disp_output_cntl >> 12) & 0x3;
1479 }
1480 } else
1481 source = (fp2_gen_cntl >> 13) & 0x1;
1482 /* sourced from CRTC2 -> exit */
1483 if (source == 1)
1484 break;
1485
1486 /* so we end up on CRTC1, let's set uses_dvo to 1 now */
1487 uses_dvo = 1;
1488 break;
1489 }
1490 #else
1491 uses_dvo = 1;
1492 #endif
1493 if (freq > rinfo->pll.ppll_max)
1494 freq = rinfo->pll.ppll_max;
1495 if (freq*12 < rinfo->pll.ppll_min)
1496 freq = rinfo->pll.ppll_min / 12;
1497 RTRACE("freq = %lu, PLL min = %u, PLL max = %u\n",
1498 freq, rinfo->pll.ppll_min, rinfo->pll.ppll_max);
1499
1500 for (post_div = &post_divs[0]; post_div->divider; ++post_div) {
1501 pll_output_freq = post_div->divider * freq;
1502 /* If we output to the DVO port (external TMDS), we don't allow an
1503 * odd PLL divider as those aren't supported on this path
1504 */
1505 if (uses_dvo && (post_div->divider & 1))
1506 continue;
1507 if (pll_output_freq >= rinfo->pll.ppll_min &&
1508 pll_output_freq <= rinfo->pll.ppll_max)
1509 break;
1510 }
1511
1512 /* If we fall through the bottom, try the "default value"
1513 given by the terminal post_div->bitvalue */
1514 if ( !post_div->divider ) {
1515 post_div = &post_divs[post_div->bitvalue];
1516 pll_output_freq = post_div->divider * freq;
1517 }
1518 RTRACE("ref_div = %d, ref_clk = %d, output_freq = %d\n",
1519 rinfo->pll.ref_div, rinfo->pll.ref_clk,
1520 pll_output_freq);
1521
1522 /* If we fall through the bottom, try the "default value"
1523 given by the terminal post_div->bitvalue */
1524 if ( !post_div->divider ) {
1525 post_div = &post_divs[post_div->bitvalue];
1526 pll_output_freq = post_div->divider * freq;
1527 }
1528 RTRACE("ref_div = %d, ref_clk = %d, output_freq = %d\n",
1529 rinfo->pll.ref_div, rinfo->pll.ref_clk,
1530 pll_output_freq);
1531
1532 fb_div = round_div(rinfo->pll.ref_div*pll_output_freq,
1533 rinfo->pll.ref_clk);
1534 regs->ppll_ref_div = rinfo->pll.ref_div;
1535 regs->ppll_div_3 = fb_div | (post_div->bitvalue << 16);
1536
1537 RTRACE("post div = 0x%x\n", post_div->bitvalue);
1538 RTRACE("fb_div = 0x%x\n", fb_div);
1539 RTRACE("ppll_div_3 = 0x%x\n", regs->ppll_div_3);
1540 }
1541
1542 static int radeonfb_set_par(struct fb_info *info)
1543 {
1544 struct radeonfb_info *rinfo = info->par;
1545 struct fb_var_screeninfo *mode = &info->var;
1546 struct radeon_regs *newmode;
1547 int hTotal, vTotal, hSyncStart, hSyncEnd,
1548 hSyncPol, vSyncStart, vSyncEnd, vSyncPol, cSync;
1549 u8 hsync_adj_tab[] = {0, 0x12, 9, 9, 6, 5};
1550 u8 hsync_fudge_fp[] = {2, 2, 0, 0, 5, 5};
1551 u32 sync, h_sync_pol, v_sync_pol, dotClock, pixClock;
1552 int i, freq;
1553 int format = 0;
1554 int nopllcalc = 0;
1555 int hsync_start, hsync_fudge, bytpp, hsync_wid, vsync_wid;
1556 int primary_mon = PRIMARY_MONITOR(rinfo);
1557 int depth = var_to_depth(mode);
1558 int use_rmx = 0;
1559
1560 newmode = kmalloc(sizeof(struct radeon_regs), GFP_KERNEL);
1561 if (!newmode)
1562 return -ENOMEM;
1563
1564 /* We always want engine to be idle on a mode switch, even
1565 * if we won't actually change the mode
1566 */
1567 radeon_engine_idle();
1568
1569 hSyncStart = mode->xres + mode->right_margin;
1570 hSyncEnd = hSyncStart + mode->hsync_len;
1571 hTotal = hSyncEnd + mode->left_margin;
1572
1573 vSyncStart = mode->yres + mode->lower_margin;
1574 vSyncEnd = vSyncStart + mode->vsync_len;
1575 vTotal = vSyncEnd + mode->upper_margin;
1576 pixClock = mode->pixclock;
1577
1578 sync = mode->sync;
1579 h_sync_pol = sync & FB_SYNC_HOR_HIGH_ACT ? 0 : 1;
1580 v_sync_pol = sync & FB_SYNC_VERT_HIGH_ACT ? 0 : 1;
1581
1582 if (primary_mon == MT_DFP || primary_mon == MT_LCD) {
1583 if (rinfo->panel_info.xres < mode->xres)
1584 mode->xres = rinfo->panel_info.xres;
1585 if (rinfo->panel_info.yres < mode->yres)
1586 mode->yres = rinfo->panel_info.yres;
1587
1588 hTotal = mode->xres + rinfo->panel_info.hblank;
1589 hSyncStart = mode->xres + rinfo->panel_info.hOver_plus;
1590 hSyncEnd = hSyncStart + rinfo->panel_info.hSync_width;
1591
1592 vTotal = mode->yres + rinfo->panel_info.vblank;
1593 vSyncStart = mode->yres + rinfo->panel_info.vOver_plus;
1594 vSyncEnd = vSyncStart + rinfo->panel_info.vSync_width;
1595
1596 h_sync_pol = !rinfo->panel_info.hAct_high;
1597 v_sync_pol = !rinfo->panel_info.vAct_high;
1598
1599 pixClock = 100000000 / rinfo->panel_info.clock;
1600
1601 if (rinfo->panel_info.use_bios_dividers) {
1602 nopllcalc = 1;
1603 newmode->ppll_div_3 = rinfo->panel_info.fbk_divider |
1604 (rinfo->panel_info.post_divider << 16);
1605 newmode->ppll_ref_div = rinfo->panel_info.ref_divider;
1606 }
1607 }
1608 dotClock = 1000000000 / pixClock;
1609 freq = dotClock / 10; /* x100 */
1610
1611 RTRACE("hStart = %d, hEnd = %d, hTotal = %d\n",
1612 hSyncStart, hSyncEnd, hTotal);
1613 RTRACE("vStart = %d, vEnd = %d, vTotal = %d\n",
1614 vSyncStart, vSyncEnd, vTotal);
1615
1616 hsync_wid = (hSyncEnd - hSyncStart) / 8;
1617 vsync_wid = vSyncEnd - vSyncStart;
1618 if (hsync_wid == 0)
1619 hsync_wid = 1;
1620 else if (hsync_wid > 0x3f) /* max */
1621 hsync_wid = 0x3f;
1622
1623 if (vsync_wid == 0)
1624 vsync_wid = 1;
1625 else if (vsync_wid > 0x1f) /* max */
1626 vsync_wid = 0x1f;
1627
1628 hSyncPol = mode->sync & FB_SYNC_HOR_HIGH_ACT ? 0 : 1;
1629 vSyncPol = mode->sync & FB_SYNC_VERT_HIGH_ACT ? 0 : 1;
1630
1631 cSync = mode->sync & FB_SYNC_COMP_HIGH_ACT ? (1 << 4) : 0;
1632
1633 format = radeon_get_dstbpp(depth);
1634 bytpp = mode->bits_per_pixel >> 3;
1635
1636 if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD))
1637 hsync_fudge = hsync_fudge_fp[format-1];
1638 else
1639 hsync_fudge = hsync_adj_tab[format-1];
1640
1641 hsync_start = hSyncStart - 8 + hsync_fudge;
1642
1643 newmode->crtc_gen_cntl = CRTC_EXT_DISP_EN | CRTC_EN |
1644 (format << 8);
1645
1646 /* Clear auto-center etc... */
1647 newmode->crtc_more_cntl = rinfo->init_state.crtc_more_cntl;
1648 newmode->crtc_more_cntl &= 0xfffffff0;
1649
1650 if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) {
1651 newmode->crtc_ext_cntl = VGA_ATI_LINEAR | XCRT_CNT_EN;
1652 if (mirror)
1653 newmode->crtc_ext_cntl |= CRTC_CRT_ON;
1654
1655 newmode->crtc_gen_cntl &= ~(CRTC_DBL_SCAN_EN |
1656 CRTC_INTERLACE_EN);
1657 } else {
1658 newmode->crtc_ext_cntl = VGA_ATI_LINEAR | XCRT_CNT_EN |
1659 CRTC_CRT_ON;
1660 }
1661
1662 newmode->dac_cntl = /* INREG(DAC_CNTL) | */ DAC_MASK_ALL | DAC_VGA_ADR_EN |
1663 DAC_8BIT_EN;
1664
1665 newmode->crtc_h_total_disp = ((((hTotal / 8) - 1) & 0x3ff) |
1666 (((mode->xres / 8) - 1) << 16));
1667
1668 newmode->crtc_h_sync_strt_wid = ((hsync_start & 0x1fff) |
1669 (hsync_wid << 16) | (h_sync_pol << 23));
1670
1671 newmode->crtc_v_total_disp = ((vTotal - 1) & 0xffff) |
1672 ((mode->yres - 1) << 16);
1673
1674 newmode->crtc_v_sync_strt_wid = (((vSyncStart - 1) & 0xfff) |
1675 (vsync_wid << 16) | (v_sync_pol << 23));
1676
1677 if (!(info->flags & FBINFO_HWACCEL_DISABLED)) {
1678 /* We first calculate the engine pitch */
1679 rinfo->pitch = ((mode->xres_virtual * ((mode->bits_per_pixel + 1) / 8) + 0x3f)
1680 & ~(0x3f)) >> 6;
1681
1682 /* Then, re-multiply it to get the CRTC pitch */
1683 newmode->crtc_pitch = (rinfo->pitch << 3) / ((mode->bits_per_pixel + 1) / 8);
1684 } else
1685 newmode->crtc_pitch = (mode->xres_virtual >> 3);
1686
1687 newmode->crtc_pitch |= (newmode->crtc_pitch << 16);
1688
1689 /*
1690 * It looks like recent chips have a problem with SURFACE_CNTL,
1691 * setting SURF_TRANSLATION_DIS completely disables the
1692 * swapper as well, so we leave it unset now.
1693 */
1694 newmode->surface_cntl = 0;
1695
1696 #if defined(__BIG_ENDIAN)
1697
1698 /* Setup swapping on both apertures, though we currently
1699 * only use aperture 0, enabling swapper on aperture 1
1700 * won't harm
1701 */
1702 switch (mode->bits_per_pixel) {
1703 case 16:
1704 newmode->surface_cntl |= NONSURF_AP0_SWP_16BPP;
1705 newmode->surface_cntl |= NONSURF_AP1_SWP_16BPP;
1706 break;
1707 case 24:
1708 case 32:
1709 newmode->surface_cntl |= NONSURF_AP0_SWP_32BPP;
1710 newmode->surface_cntl |= NONSURF_AP1_SWP_32BPP;
1711 break;
1712 }
1713 #endif
1714
1715 /* Clear surface registers */
1716 for (i=0; i<8; i++) {
1717 newmode->surf_lower_bound[i] = 0;
1718 newmode->surf_upper_bound[i] = 0x1f;
1719 newmode->surf_info[i] = 0;
1720 }
1721
1722 RTRACE("h_total_disp = 0x%x\t hsync_strt_wid = 0x%x\n",
1723 newmode->crtc_h_total_disp, newmode->crtc_h_sync_strt_wid);
1724 RTRACE("v_total_disp = 0x%x\t vsync_strt_wid = 0x%x\n",
1725 newmode->crtc_v_total_disp, newmode->crtc_v_sync_strt_wid);
1726
1727 rinfo->bpp = mode->bits_per_pixel;
1728 rinfo->depth = depth;
1729
1730 RTRACE("pixclock = %lu\n", (unsigned long)pixClock);
1731 RTRACE("freq = %lu\n", (unsigned long)freq);
1732
1733 /* We use PPLL_DIV_3 */
1734 newmode->clk_cntl_index = 0x300;
1735
1736 /* Calculate PPLL value if necessary */
1737 if (!nopllcalc)
1738 radeon_calc_pll_regs(rinfo, newmode, freq);
1739
1740 newmode->vclk_ecp_cntl = rinfo->init_state.vclk_ecp_cntl;
1741
1742 if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) {
1743 unsigned int hRatio, vRatio;
1744
1745 if (mode->xres > rinfo->panel_info.xres)
1746 mode->xres = rinfo->panel_info.xres;
1747 if (mode->yres > rinfo->panel_info.yres)
1748 mode->yres = rinfo->panel_info.yres;
1749
1750 newmode->fp_horz_stretch = (((rinfo->panel_info.xres / 8) - 1)
1751 << HORZ_PANEL_SHIFT);
1752 newmode->fp_vert_stretch = ((rinfo->panel_info.yres - 1)
1753 << VERT_PANEL_SHIFT);
1754
1755 if (mode->xres != rinfo->panel_info.xres) {
1756 hRatio = round_div(mode->xres * HORZ_STRETCH_RATIO_MAX,
1757 rinfo->panel_info.xres);
1758 newmode->fp_horz_stretch = (((((unsigned long)hRatio) & HORZ_STRETCH_RATIO_MASK)) |
1759 (newmode->fp_horz_stretch &
1760 (HORZ_PANEL_SIZE | HORZ_FP_LOOP_STRETCH |
1761 HORZ_AUTO_RATIO_INC)));
1762 newmode->fp_horz_stretch |= (HORZ_STRETCH_BLEND |
1763 HORZ_STRETCH_ENABLE);
1764 use_rmx = 1;
1765 }
1766 newmode->fp_horz_stretch &= ~HORZ_AUTO_RATIO;
1767
1768 if (mode->yres != rinfo->panel_info.yres) {
1769 vRatio = round_div(mode->yres * VERT_STRETCH_RATIO_MAX,
1770 rinfo->panel_info.yres);
1771 newmode->fp_vert_stretch = (((((unsigned long)vRatio) & VERT_STRETCH_RATIO_MASK)) |
1772 (newmode->fp_vert_stretch &
1773 (VERT_PANEL_SIZE | VERT_STRETCH_RESERVED)));
1774 newmode->fp_vert_stretch |= (VERT_STRETCH_BLEND |
1775 VERT_STRETCH_ENABLE);
1776 use_rmx = 1;
1777 }
1778 newmode->fp_vert_stretch &= ~VERT_AUTO_RATIO_EN;
1779
1780 newmode->fp_gen_cntl = (rinfo->init_state.fp_gen_cntl & (u32)
1781 ~(FP_SEL_CRTC2 |
1782 FP_RMX_HVSYNC_CONTROL_EN |
1783 FP_DFP_SYNC_SEL |
1784 FP_CRT_SYNC_SEL |
1785 FP_CRTC_LOCK_8DOT |
1786 FP_USE_SHADOW_EN |
1787 FP_CRTC_USE_SHADOW_VEND |
1788 FP_CRT_SYNC_ALT));
1789
1790 newmode->fp_gen_cntl |= (FP_CRTC_DONT_SHADOW_VPAR |
1791 FP_CRTC_DONT_SHADOW_HEND |
1792 FP_PANEL_FORMAT);
1793
1794 if (IS_R300_VARIANT(rinfo) ||
1795 (rinfo->family == CHIP_FAMILY_R200)) {
1796 newmode->fp_gen_cntl &= ~R200_FP_SOURCE_SEL_MASK;
1797 if (use_rmx)
1798 newmode->fp_gen_cntl |= R200_FP_SOURCE_SEL_RMX;
1799 else
1800 newmode->fp_gen_cntl |= R200_FP_SOURCE_SEL_CRTC1;
1801 } else
1802 newmode->fp_gen_cntl |= FP_SEL_CRTC1;
1803
1804 newmode->lvds_gen_cntl = rinfo->init_state.lvds_gen_cntl;
1805 newmode->lvds_pll_cntl = rinfo->init_state.lvds_pll_cntl;
1806 newmode->tmds_crc = rinfo->init_state.tmds_crc;
1807 newmode->tmds_transmitter_cntl = rinfo->init_state.tmds_transmitter_cntl;
1808
1809 if (primary_mon == MT_LCD) {
1810 newmode->lvds_gen_cntl |= (LVDS_ON | LVDS_BLON);
1811 newmode->fp_gen_cntl &= ~(FP_FPON | FP_TMDS_EN);
1812 } else {
1813 /* DFP */
1814 newmode->fp_gen_cntl |= (FP_FPON | FP_TMDS_EN);
1815 newmode->tmds_transmitter_cntl &= ~(TMDS_PLLRST);
1816 /* TMDS_PLL_EN bit is reversed on RV (and mobility) chips */
1817 if (IS_R300_VARIANT(rinfo) ||
1818 (rinfo->family == CHIP_FAMILY_R200) || !rinfo->has_CRTC2)
1819 newmode->tmds_transmitter_cntl &= ~TMDS_PLL_EN;
1820 else
1821 newmode->tmds_transmitter_cntl |= TMDS_PLL_EN;
1822 newmode->crtc_ext_cntl &= ~CRTC_CRT_ON;
1823 }
1824
1825 newmode->fp_crtc_h_total_disp = (((rinfo->panel_info.hblank / 8) & 0x3ff) |
1826 (((mode->xres / 8) - 1) << 16));
1827 newmode->fp_crtc_v_total_disp = (rinfo->panel_info.vblank & 0xffff) |
1828 ((mode->yres - 1) << 16);
1829 newmode->fp_h_sync_strt_wid = ((rinfo->panel_info.hOver_plus & 0x1fff) |
1830 (hsync_wid << 16) | (h_sync_pol << 23));
1831 newmode->fp_v_sync_strt_wid = ((rinfo->panel_info.vOver_plus & 0xfff) |
1832 (vsync_wid << 16) | (v_sync_pol << 23));
1833 }
1834
1835 /* do it! */
1836 if (!rinfo->asleep) {
1837 memcpy(&rinfo->state, newmode, sizeof(*newmode));
1838 radeon_write_mode (rinfo, newmode, 0);
1839 /* (re)initialize the engine */
1840 if (!(info->flags & FBINFO_HWACCEL_DISABLED))
1841 radeonfb_engine_init (rinfo);
1842 }
1843 /* Update fix */
1844 if (!(info->flags & FBINFO_HWACCEL_DISABLED))
1845 info->fix.line_length = rinfo->pitch*64;
1846 else
1847 info->fix.line_length = mode->xres_virtual
1848 * ((mode->bits_per_pixel + 1) / 8);
1849 info->fix.visual = rinfo->depth == 8 ? FB_VISUAL_PSEUDOCOLOR
1850 : FB_VISUAL_DIRECTCOLOR;
1851
1852 #ifdef CONFIG_BOOTX_TEXT
1853 /* Update debug text engine */
1854 btext_update_display(rinfo->fb_base_phys, mode->xres, mode->yres,
1855 rinfo->depth, info->fix.line_length);
1856 #endif
1857
1858 kfree(newmode);
1859 return 0;
1860 }
1861
1862
1863 static struct fb_ops radeonfb_ops = {
1864 .owner = THIS_MODULE,
1865 .fb_check_var = radeonfb_check_var,
1866 .fb_set_par = radeonfb_set_par,
1867 .fb_setcolreg = radeonfb_setcolreg,
1868 .fb_setcmap = radeonfb_setcmap,
1869 .fb_pan_display = radeonfb_pan_display,
1870 .fb_blank = radeonfb_blank,
1871 .fb_ioctl = radeonfb_ioctl,
1872 .fb_sync = radeonfb_sync,
1873 .fb_fillrect = radeonfb_fillrect,
1874 .fb_copyarea = radeonfb_copyarea,
1875 .fb_imageblit = radeonfb_imageblit,
1876 .fb_cursor = soft_cursor,
1877 };
1878
1879
1880 static int __devinit radeon_set_fbinfo (struct radeonfb_info *rinfo)
1881 {
1882 struct fb_info *info = rinfo->info;
1883
1884 info->par = rinfo;
1885 info->pseudo_palette = rinfo->pseudo_palette;
1886 info->flags = FBINFO_DEFAULT
1887 | FBINFO_HWACCEL_COPYAREA
1888 | FBINFO_HWACCEL_FILLRECT
1889 | FBINFO_HWACCEL_XPAN
1890 | FBINFO_HWACCEL_YPAN;
1891 info->fbops = &radeonfb_ops;
1892 info->screen_base = rinfo->fb_base;
1893 info->screen_size = rinfo->mapped_vram;
1894 /* Fill fix common fields */
1895 strlcpy(info->fix.id, rinfo->name, sizeof(info->fix.id));
1896 info->fix.smem_start = rinfo->fb_base_phys;
1897 info->fix.smem_len = rinfo->video_ram;
1898 info->fix.type = FB_TYPE_PACKED_PIXELS;
1899 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
1900 info->fix.xpanstep = 8;
1901 info->fix.ypanstep = 1;
1902 info->fix.ywrapstep = 0;
1903 info->fix.type_aux = 0;
1904 info->fix.mmio_start = rinfo->mmio_base_phys;
1905 info->fix.mmio_len = RADEON_REGSIZE;
1906 info->fix.accel = FB_ACCEL_ATI_RADEON;
1907
1908 fb_alloc_cmap(&info->cmap, 256, 0);
1909
1910 if (noaccel)
1911 info->flags |= FBINFO_HWACCEL_DISABLED;
1912
1913 return 0;
1914 }
1915
1916
1917 #ifdef CONFIG_PMAC_BACKLIGHT
1918
1919 /* TODO: Dbl check these tables, we don't go up to full ON backlight
1920 * in these, possibly because we noticed MacOS doesn't, but I'd prefer
1921 * having some more official numbers from ATI
1922 */
1923 static int backlight_conv_m6[] = {
1924 0xff, 0xc0, 0xb5, 0xaa, 0x9f, 0x94, 0x89, 0x7e,
1925 0x73, 0x68, 0x5d, 0x52, 0x47, 0x3c, 0x31, 0x24
1926 };
1927 static int backlight_conv_m7[] = {
1928 0x00, 0x3f, 0x4a, 0x55, 0x60, 0x6b, 0x76, 0x81,
1929 0x8c, 0x97, 0xa2, 0xad, 0xb8, 0xc3, 0xce, 0xd9
1930 };
1931
1932 #define BACKLIGHT_LVDS_OFF
1933 #undef BACKLIGHT_DAC_OFF
1934
1935 /* We turn off the LCD completely instead of just dimming the backlight.
1936 * This provides some greater power saving and the display is useless
1937 * without backlight anyway.
1938 */
1939 static int radeon_set_backlight_enable(int on, int level, void *data)
1940 {
1941 struct radeonfb_info *rinfo = (struct radeonfb_info *)data;
1942 u32 lvds_gen_cntl, tmpPixclksCntl;
1943 int* conv_table;
1944
1945 if (rinfo->mon1_type != MT_LCD)
1946 return 0;
1947
1948 /* Pardon me for that hack... maybe some day we can figure
1949 * out in what direction backlight should work on a given
1950 * panel ?
1951 */
1952 if ((rinfo->family == CHIP_FAMILY_RV200 ||
1953 rinfo->family == CHIP_FAMILY_RV250 ||
1954 rinfo->family == CHIP_FAMILY_RV280 ||
1955 rinfo->family == CHIP_FAMILY_RV350) &&
1956 !machine_is_compatible("PowerBook4,3") &&
1957 !machine_is_compatible("PowerBook6,3") &&
1958 !machine_is_compatible("PowerBook6,5"))
1959 conv_table = backlight_conv_m7;
1960 else
1961 conv_table = backlight_conv_m6;
1962
1963 del_timer_sync(&rinfo->lvds_timer);
1964 radeon_engine_idle();
1965
1966 lvds_gen_cntl = INREG(LVDS_GEN_CNTL);
1967 if (on && (level > BACKLIGHT_OFF)) {
1968 lvds_gen_cntl &= ~LVDS_DISPLAY_DIS;
1969 if (!(lvds_gen_cntl & LVDS_BLON) || !(lvds_gen_cntl & LVDS_ON)) {
1970 lvds_gen_cntl |= (rinfo->init_state.lvds_gen_cntl & LVDS_DIGON);
1971 lvds_gen_cntl |= LVDS_BLON | LVDS_EN;
1972 OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl);
1973 lvds_gen_cntl &= ~LVDS_BL_MOD_LEVEL_MASK;
1974 lvds_gen_cntl |= (conv_table[level] <<
1975 LVDS_BL_MOD_LEVEL_SHIFT);
1976 lvds_gen_cntl |= LVDS_ON;
1977 lvds_gen_cntl |= (rinfo->init_state.lvds_gen_cntl & LVDS_BL_MOD_EN);
1978 rinfo->pending_lvds_gen_cntl = lvds_gen_cntl;
1979 mod_timer(&rinfo->lvds_timer,
1980 jiffies + msecs_to_jiffies(rinfo->panel_info.pwr_delay));
1981 } else {
1982 lvds_gen_cntl &= ~LVDS_BL_MOD_LEVEL_MASK;
1983 lvds_gen_cntl |= (conv_table[level] <<
1984 LVDS_BL_MOD_LEVEL_SHIFT);
1985 OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl);
1986 }
1987 rinfo->init_state.lvds_gen_cntl &= ~LVDS_STATE_MASK;
1988 rinfo->init_state.lvds_gen_cntl |= rinfo->pending_lvds_gen_cntl
1989 & LVDS_STATE_MASK;
1990 } else {
1991 /* Asic bug, when turning off LVDS_ON, we have to make sure
1992 RADEON_PIXCLK_LVDS_ALWAYS_ON bit is off
1993 */
1994 tmpPixclksCntl = INPLL(PIXCLKS_CNTL);
1995 if (rinfo->is_mobility || rinfo->is_IGP)
1996 OUTPLLP(PIXCLKS_CNTL, 0, ~PIXCLK_LVDS_ALWAYS_ONb);
1997 lvds_gen_cntl &= ~(LVDS_BL_MOD_LEVEL_MASK | LVDS_BL_MOD_EN);
1998 lvds_gen_cntl |= (conv_table[0] <<
1999 LVDS_BL_MOD_LEVEL_SHIFT);
2000 lvds_gen_cntl |= LVDS_DISPLAY_DIS;
2001 OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl);
2002 udelay(100);
2003 lvds_gen_cntl &= ~(LVDS_ON | LVDS_EN);
2004 OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl);
2005 lvds_gen_cntl &= ~(LVDS_DIGON);
2006 rinfo->pending_lvds_gen_cntl = lvds_gen_cntl;
2007 mod_timer(&rinfo->lvds_timer,
2008 jiffies + msecs_to_jiffies(rinfo->panel_info.pwr_delay));
2009 if (rinfo->is_mobility || rinfo->is_IGP)
2010 OUTPLL(PIXCLKS_CNTL, tmpPixclksCntl);
2011 }
2012 rinfo->init_state.lvds_gen_cntl &= ~LVDS_STATE_MASK;
2013 rinfo->init_state.lvds_gen_cntl |= (lvds_gen_cntl & LVDS_STATE_MASK);
2014
2015 return 0;
2016 }
2017
2018
2019 static int radeon_set_backlight_level(int level, void *data)
2020 {
2021 return radeon_set_backlight_enable(1, level, data);
2022 }
2023 #endif /* CONFIG_PMAC_BACKLIGHT */
2024
2025
2026 /*
2027 * This reconfigure the card's internal memory map. In theory, we'd like
2028 * to setup the card's memory at the same address as it's PCI bus address,
2029 * and the AGP aperture right after that so that system RAM on 32 bits
2030 * machines at least, is directly accessible. However, doing so would
2031 * conflict with the current XFree drivers...
2032 * Ultimately, I hope XFree, GATOS and ATI binary drivers will all agree
2033 * on the proper way to set this up and duplicate this here. In the meantime,
2034 * I put the card's memory at 0 in card space and AGP at some random high
2035 * local (0xe0000000 for now) that will be changed by XFree/DRI anyway
2036 */
2037 #ifdef CONFIG_PPC_OF
2038 #undef SET_MC_FB_FROM_APERTURE
2039 static void fixup_memory_mappings(struct radeonfb_info *rinfo)
2040 {
2041 u32 save_crtc_gen_cntl, save_crtc2_gen_cntl = 0;
2042 u32 save_crtc_ext_cntl;
2043 u32 aper_base, aper_size;
2044 u32 agp_base;
2045
2046 /* First, we disable display to avoid interfering */
2047 if (rinfo->has_CRTC2) {
2048 save_crtc2_gen_cntl = INREG(CRTC2_GEN_CNTL);
2049 OUTREG(CRTC2_GEN_CNTL, save_crtc2_gen_cntl | CRTC2_DISP_REQ_EN_B);
2050 }
2051 save_crtc_gen_cntl = INREG(CRTC_GEN_CNTL);
2052 save_crtc_ext_cntl = INREG(CRTC_EXT_CNTL);
2053
2054 OUTREG(CRTC_EXT_CNTL, save_crtc_ext_cntl | CRTC_DISPLAY_DIS);
2055 OUTREG(CRTC_GEN_CNTL, save_crtc_gen_cntl | CRTC_DISP_REQ_EN_B);
2056 mdelay(100);
2057
2058 aper_base = INREG(CONFIG_APER_0_BASE);
2059 aper_size = INREG(CONFIG_APER_SIZE);
2060
2061 #ifdef SET_MC_FB_FROM_APERTURE
2062 /* Set framebuffer to be at the same address as set in PCI BAR */
2063 OUTREG(MC_FB_LOCATION,
2064 ((aper_base + aper_size - 1) & 0xffff0000) | (aper_base >> 16));
2065 rinfo->fb_local_base = aper_base;
2066 #else
2067 OUTREG(MC_FB_LOCATION, 0x7fff0000);
2068 rinfo->fb_local_base = 0;
2069 #endif
2070 agp_base = aper_base + aper_size;
2071 if (agp_base & 0xf0000000)
2072 agp_base = (aper_base | 0x0fffffff) + 1;
2073
2074 /* Set AGP to be just after the framebuffer on a 256Mb boundary. This
2075 * assumes the FB isn't mapped to 0xf0000000 or above, but this is
2076 * always the case on PPCs afaik.
2077 */
2078 #ifdef SET_MC_FB_FROM_APERTURE
2079 OUTREG(MC_AGP_LOCATION, 0xffff0000 | (agp_base >> 16));
2080 #else
2081 OUTREG(MC_AGP_LOCATION, 0xffffe000);
2082 #endif
2083
2084 /* Fixup the display base addresses & engine offsets while we
2085 * are at it as well
2086 */
2087 #ifdef SET_MC_FB_FROM_APERTURE
2088 OUTREG(DISPLAY_BASE_ADDR, aper_base);
2089 if (rinfo->has_CRTC2)
2090 OUTREG(CRTC2_DISPLAY_BASE_ADDR, aper_base);
2091 OUTREG(OV0_BASE_ADDR, aper_base);
2092 #else
2093 OUTREG(DISPLAY_BASE_ADDR, 0);
2094 if (rinfo->has_CRTC2)
2095 OUTREG(CRTC2_DISPLAY_BASE_ADDR, 0);
2096 OUTREG(OV0_BASE_ADDR, 0);
2097 #endif
2098 mdelay(100);
2099
2100 /* Restore display settings */
2101 OUTREG(CRTC_GEN_CNTL, save_crtc_gen_cntl);
2102 OUTREG(CRTC_EXT_CNTL, save_crtc_ext_cntl);
2103 if (rinfo->has_CRTC2)
2104 OUTREG(CRTC2_GEN_CNTL, save_crtc2_gen_cntl);
2105
2106 RTRACE("aper_base: %08x MC_FB_LOC to: %08x, MC_AGP_LOC to: %08x\n",
2107 aper_base,
2108 ((aper_base + aper_size - 1) & 0xffff0000) | (aper_base >> 16),
2109 0xffff0000 | (agp_base >> 16));
2110 }
2111 #endif /* CONFIG_PPC_OF */
2112
2113
2114 static void radeon_identify_vram(struct radeonfb_info *rinfo)
2115 {
2116 u32 tmp;
2117
2118 /* framebuffer size */
2119 if ((rinfo->family == CHIP_FAMILY_RS100) ||
2120 (rinfo->family == CHIP_FAMILY_RS200) ||
2121 (rinfo->family == CHIP_FAMILY_RS300)) {
2122 u32 tom = INREG(NB_TOM);
2123 tmp = ((((tom >> 16) - (tom & 0xffff) + 1) << 6) * 1024);
2124
2125 radeon_fifo_wait(6);
2126 OUTREG(MC_FB_LOCATION, tom);
2127 OUTREG(DISPLAY_BASE_ADDR, (tom & 0xffff) << 16);
2128 OUTREG(CRTC2_DISPLAY_BASE_ADDR, (tom & 0xffff) << 16);
2129 OUTREG(OV0_BASE_ADDR, (tom & 0xffff) << 16);
2130
2131 /* This is supposed to fix the crtc2 noise problem. */
2132 OUTREG(GRPH2_BUFFER_CNTL, INREG(GRPH2_BUFFER_CNTL) & ~0x7f0000);
2133
2134 if ((rinfo->family == CHIP_FAMILY_RS100) ||
2135 (rinfo->family == CHIP_FAMILY_RS200)) {
2136 /* This is to workaround the asic bug for RMX, some versions
2137 of BIOS dosen't have this register initialized correctly.
2138 */
2139 OUTREGP(CRTC_MORE_CNTL, CRTC_H_CUTOFF_ACTIVE_EN,
2140 ~CRTC_H_CUTOFF_ACTIVE_EN);
2141 }
2142 } else {
2143 tmp = INREG(CONFIG_MEMSIZE);
2144 }
2145
2146 /* mem size is bits [28:0], mask off the rest */
2147 rinfo->video_ram = tmp & CONFIG_MEMSIZE_MASK;
2148
2149 /*
2150 * Hack to get around some busted production M6's
2151 * reporting no ram
2152 */
2153 if (rinfo->video_ram == 0) {
2154 switch (rinfo->pdev->device) {
2155 case PCI_CHIP_RADEON_LY:
2156 case PCI_CHIP_RADEON_LZ:
2157 rinfo->video_ram = 8192 * 1024;
2158 break;
2159 default:
2160 break;
2161 }
2162 }
2163
2164
2165 /*
2166 * Now try to identify VRAM type
2167 */
2168 if (rinfo->is_IGP || (rinfo->family >= CHIP_FAMILY_R300) ||
2169 (INREG(MEM_SDRAM_MODE_REG) & (1<<30)))
2170 rinfo->vram_ddr = 1;
2171 else
2172 rinfo->vram_ddr = 0;
2173
2174 tmp = INREG(MEM_CNTL);
2175 if (IS_R300_VARIANT(rinfo)) {
2176 tmp &= R300_MEM_NUM_CHANNELS_MASK;
2177 switch (tmp) {
2178 case 0: rinfo->vram_width = 64; break;
2179 case 1: rinfo->vram_width = 128; break;
2180 case 2: rinfo->vram_width = 256; break;
2181 default: rinfo->vram_width = 128; break;
2182 }
2183 } else if ((rinfo->family == CHIP_FAMILY_RV100) ||
2184 (rinfo->family == CHIP_FAMILY_RS100) ||
2185 (rinfo->family == CHIP_FAMILY_RS200)){
2186 if (tmp & RV100_MEM_HALF_MODE)
2187 rinfo->vram_width = 32;
2188 else
2189 rinfo->vram_width = 64;
2190 } else {
2191 if (tmp & MEM_NUM_CHANNELS_MASK)
2192 rinfo->vram_width = 128;
2193 else
2194 rinfo->vram_width = 64;
2195 }
2196
2197 /* This may not be correct, as some cards can have half of channel disabled
2198 * ToDo: identify these cases
2199 */
2200
2201 RTRACE("radeonfb (%s): Found %ldk of %s %d bits wide videoram\n",
2202 pci_name(rinfo->pdev),
2203 rinfo->video_ram / 1024,
2204 rinfo->vram_ddr ? "DDR" : "SDRAM",
2205 rinfo->vram_width);
2206 }
2207
2208 /*
2209 * Sysfs
2210 */
2211
2212 static ssize_t radeon_show_one_edid(char *buf, loff_t off, size_t count, const u8 *edid)
2213 {
2214 if (off > EDID_LENGTH)
2215 return 0;
2216
2217 if (off + count > EDID_LENGTH)
2218 count = EDID_LENGTH - off;
2219
2220 memcpy(buf, edid + off, count);
2221
2222 return count;
2223 }
2224
2225
2226 static ssize_t radeon_show_edid1(struct kobject *kobj, char *buf, loff_t off, size_t count)
2227 {
2228 struct device *dev = container_of(kobj, struct device, kobj);
2229 struct pci_dev *pdev = to_pci_dev(dev);
2230 struct fb_info *info = pci_get_drvdata(pdev);
2231 struct radeonfb_info *rinfo = info->par;
2232
2233 return radeon_show_one_edid(buf, off, count, rinfo->mon1_EDID);
2234 }
2235
2236
2237 static ssize_t radeon_show_edid2(struct kobject *kobj, char *buf, loff_t off, size_t count)
2238 {
2239 struct device *dev = container_of(kobj, struct device, kobj);
2240 struct pci_dev *pdev = to_pci_dev(dev);
2241 struct fb_info *info = pci_get_drvdata(pdev);
2242 struct radeonfb_info *rinfo = info->par;
2243
2244 return radeon_show_one_edid(buf, off, count, rinfo->mon2_EDID);
2245 }
2246
2247 static struct bin_attribute edid1_attr = {
2248 .attr = {
2249 .name = "edid1",
2250 .owner = THIS_MODULE,
2251 .mode = 0444,
2252 },
2253 .size = EDID_LENGTH,
2254 .read = radeon_show_edid1,
2255 };
2256
2257 static struct bin_attribute edid2_attr = {
2258 .attr = {
2259 .name = "edid2",
2260 .owner = THIS_MODULE,
2261 .mode = 0444,
2262 },
2263 .size = EDID_LENGTH,
2264 .read = radeon_show_edid2,
2265 };
2266
2267
2268 static int radeonfb_pci_register (struct pci_dev *pdev,
2269 const struct pci_device_id *ent)
2270 {
2271 struct fb_info *info;
2272 struct radeonfb_info *rinfo;
2273 int ret;
2274
2275 RTRACE("radeonfb_pci_register BEGIN\n");
2276
2277 /* Enable device in PCI config */
2278 ret = pci_enable_device(pdev);
2279 if (ret < 0) {
2280 printk(KERN_ERR "radeonfb (%s): Cannot enable PCI device\n",
2281 pci_name(pdev));
2282 goto err_out;
2283 }
2284
2285 info = framebuffer_alloc(sizeof(struct radeonfb_info), &pdev->dev);
2286 if (!info) {
2287 printk (KERN_ERR "radeonfb (%s): could not allocate memory\n",
2288 pci_name(pdev));
2289 ret = -ENOMEM;
2290 goto err_disable;
2291 }
2292 rinfo = info->par;
2293 rinfo->info = info;
2294 rinfo->pdev = pdev;
2295
2296 spin_lock_init(&rinfo->reg_lock);
2297 init_timer(&rinfo->lvds_timer);
2298 rinfo->lvds_timer.function = radeon_lvds_timer_func;
2299 rinfo->lvds_timer.data = (unsigned long)rinfo;
2300
2301 strcpy(rinfo->name, "ATI Radeon XX ");
2302 rinfo->name[11] = ent->device >> 8;
2303 rinfo->name[12] = ent->device & 0xFF;
2304 rinfo->family = ent->driver_data & CHIP_FAMILY_MASK;
2305 rinfo->chipset = pdev->device;
2306 rinfo->has_CRTC2 = (ent->driver_data & CHIP_HAS_CRTC2) != 0;
2307 rinfo->is_mobility = (ent->driver_data & CHIP_IS_MOBILITY) != 0;
2308 rinfo->is_IGP = (ent->driver_data & CHIP_IS_IGP) != 0;
2309
2310 /* Set base addrs */
2311 rinfo->fb_base_phys = pci_resource_start (pdev, 0);
2312 rinfo->mmio_base_phys = pci_resource_start (pdev, 2);
2313
2314 /* request the mem regions */
2315 ret = pci_request_regions(pdev, "radeonfb");
2316 if (ret < 0) {
2317 printk( KERN_ERR "radeonfb (%s): cannot reserve PCI regions."
2318 " Someone already got them?\n", pci_name(rinfo->pdev));
2319 goto err_release_fb;
2320 }
2321
2322 /* map the regions */
2323 rinfo->mmio_base = ioremap(rinfo->mmio_base_phys, RADEON_REGSIZE);
2324 if (!rinfo->mmio_base) {
2325 printk(KERN_ERR "radeonfb (%s): cannot map MMIO\n", pci_name(rinfo->pdev));
2326 ret = -EIO;
2327 goto err_release_pci;
2328 }
2329
2330 rinfo->fb_local_base = INREG(MC_FB_LOCATION) << 16;
2331
2332 /*
2333 * Check for errata
2334 */
2335 rinfo->errata = 0;
2336 if (rinfo->family == CHIP_FAMILY_R300 &&
2337 (INREG(CONFIG_CNTL) & CFG_ATI_REV_ID_MASK)
2338 == CFG_ATI_REV_A11)
2339 rinfo->errata |= CHIP_ERRATA_R300_CG;
2340
2341 if (rinfo->family == CHIP_FAMILY_RV200 ||
2342 rinfo->family == CHIP_FAMILY_RS200)
2343 rinfo->errata |= CHIP_ERRATA_PLL_DUMMYREADS;
2344
2345 if (rinfo->family == CHIP_FAMILY_RV100 ||
2346 rinfo->family == CHIP_FAMILY_RS100 ||
2347 rinfo->family == CHIP_FAMILY_RS200)
2348 rinfo->errata |= CHIP_ERRATA_PLL_DELAY;
2349
2350 #ifdef CONFIG_PPC_OF
2351 /* On PPC, we obtain the OF device-node pointer to the firmware
2352 * data for this chip
2353 */
2354 rinfo->of_node = pci_device_to_OF_node(pdev);
2355 if (rinfo->of_node == NULL)
2356 printk(KERN_WARNING "radeonfb (%s): Cannot match card to OF node !\n",
2357 pci_name(rinfo->pdev));
2358
2359 /* On PPC, the firmware sets up a memory mapping that tends
2360 * to cause lockups when enabling the engine. We reconfigure
2361 * the card internal memory mappings properly
2362 */
2363 fixup_memory_mappings(rinfo);
2364 #endif /* CONFIG_PPC_OF */
2365
2366 /* Get VRAM size and type */
2367 radeon_identify_vram(rinfo);
2368
2369 rinfo->mapped_vram = min_t(unsigned long, MAX_MAPPED_VRAM, rinfo->video_ram);
2370
2371 do {
2372 rinfo->fb_base = ioremap (rinfo->fb_base_phys,
2373 rinfo->mapped_vram);
2374 } while ( rinfo->fb_base == 0 &&
2375 ((rinfo->mapped_vram /=2) >= MIN_MAPPED_VRAM) );
2376
2377 if (rinfo->fb_base)
2378 memset_io(rinfo->fb_base, 0, rinfo->mapped_vram);
2379 else {
2380 printk (KERN_ERR "radeonfb (%s): cannot map FB\n", pci_name(rinfo->pdev));
2381 ret = -EIO;
2382 goto err_unmap_rom;
2383 }
2384
2385 RTRACE("radeonfb (%s): mapped %ldk videoram\n", pci_name(rinfo->pdev),
2386 rinfo->mapped_vram/1024);
2387
2388 /*
2389 * Map the BIOS ROM if any and retreive PLL parameters from
2390 * the BIOS. We skip that on mobility chips as the real panel
2391 * values we need aren't in the ROM but in the BIOS image in
2392 * memory. This is definitely not the best meacnism though,
2393 * we really need the arch code to tell us which is the "primary"
2394 * video adapter to use the memory image (or better, the arch
2395 * should provide us a copy of the BIOS image to shield us from
2396 * archs who would store that elsewhere and/or could initialize
2397 * more than one adapter during boot).
2398 */
2399 if (!rinfo->is_mobility)
2400 radeon_map_ROM(rinfo, pdev);
2401
2402 /*
2403 * On x86, the primary display on laptop may have it's BIOS
2404 * ROM elsewhere, try to locate it at the legacy memory hole.
2405 * We probably need to make sure this is the primary display,
2406 * but that is difficult without some arch support.
2407 */
2408 #ifdef CONFIG_X86
2409 if (rinfo->bios_seg == NULL)
2410 radeon_find_mem_vbios(rinfo);
2411 #endif
2412
2413 /* If both above failed, try the BIOS ROM again for mobility
2414 * chips
2415 */
2416 if (rinfo->bios_seg == NULL && rinfo->is_mobility)
2417 radeon_map_ROM(rinfo, pdev);
2418
2419 /* Get informations about the board's PLL */
2420 radeon_get_pllinfo(rinfo);
2421
2422 #ifdef CONFIG_FB_RADEON_I2C
2423 /* Register I2C bus */
2424 radeon_create_i2c_busses(rinfo);
2425 #endif
2426
2427 /* set all the vital stuff */
2428 radeon_set_fbinfo (rinfo);
2429
2430 /* Probe screen types */
2431 radeon_probe_screens(rinfo, monitor_layout, ignore_edid);
2432
2433 /* Build mode list, check out panel native model */
2434 radeon_check_modes(rinfo, mode_option);
2435
2436 /* Register some sysfs stuff (should be done better) */
2437 if (rinfo->mon1_EDID)
2438 sysfs_create_bin_file(&rinfo->pdev->dev.kobj, &edid1_attr);
2439 if (rinfo->mon2_EDID)
2440 sysfs_create_bin_file(&rinfo->pdev->dev.kobj, &edid2_attr);
2441
2442 /* save current mode regs before we switch into the new one
2443 * so we can restore this upon __exit
2444 */
2445 radeon_save_state (rinfo, &rinfo->init_state);
2446 memcpy(&rinfo->state, &rinfo->init_state, sizeof(struct radeon_regs));
2447
2448 /* Setup Power Management capabilities */
2449 if (default_dynclk < -1) {
2450 /* -2 is special: means ON on mobility chips and do not
2451 * change on others
2452 */
2453 radeonfb_pm_init(rinfo, rinfo->is_mobility ? 1 : -1);
2454 } else
2455 radeonfb_pm_init(rinfo, default_dynclk);
2456
2457 pci_set_drvdata(pdev, info);
2458
2459 /* Register with fbdev layer */
2460 ret = register_framebuffer(info);
2461 if (ret < 0) {
2462 printk (KERN_ERR "radeonfb (%s): could not register framebuffer\n",
2463 pci_name(rinfo->pdev));
2464 goto err_unmap_fb;
2465 }
2466
2467 #ifdef CONFIG_MTRR
2468 rinfo->mtrr_hdl = nomtrr ? -1 : mtrr_add(rinfo->fb_base_phys,
2469 rinfo->video_ram,
2470 MTRR_TYPE_WRCOMB, 1);
2471 #endif
2472
2473 #ifdef CONFIG_PMAC_BACKLIGHT
2474 if (rinfo->mon1_type == MT_LCD) {
2475 register_backlight_controller(&radeon_backlight_controller,
2476 rinfo, "ati");
2477 register_backlight_controller(&radeon_backlight_controller,
2478 rinfo, "mnca");
2479 }
2480 #endif
2481
2482 printk ("radeonfb (%s): %s\n", pci_name(rinfo->pdev), rinfo->name);
2483
2484 if (rinfo->bios_seg)
2485 radeon_unmap_ROM(rinfo, pdev);
2486 RTRACE("radeonfb_pci_register END\n");
2487
2488 return 0;
2489 err_unmap_fb:
2490 iounmap(rinfo->fb_base);
2491 err_unmap_rom:
2492 kfree(rinfo->mon1_EDID);
2493 kfree(rinfo->mon2_EDID);
2494 if (rinfo->mon1_modedb)
2495 fb_destroy_modedb(rinfo->mon1_modedb);
2496 fb_dealloc_cmap(&info->cmap);
2497 #ifdef CONFIG_FB_RADEON_I2C
2498 radeon_delete_i2c_busses(rinfo);
2499 #endif
2500 if (rinfo->bios_seg)
2501 radeon_unmap_ROM(rinfo, pdev);
2502 iounmap(rinfo->mmio_base);
2503 err_release_pci:
2504 pci_release_regions(pdev);
2505 err_release_fb:
2506 framebuffer_release(info);
2507 err_disable:
2508 pci_disable_device(pdev);
2509 err_out:
2510 return ret;
2511 }
2512
2513
2514
2515 static void __devexit radeonfb_pci_unregister (struct pci_dev *pdev)
2516 {
2517 struct fb_info *info = pci_get_drvdata(pdev);
2518 struct radeonfb_info *rinfo = info->par;
2519
2520 if (!rinfo)
2521 return;
2522
2523 radeonfb_pm_exit(rinfo);
2524
2525 #if 0
2526 /* restore original state
2527 *
2528 * Doesn't quite work yet, I suspect if we come from a legacy
2529 * VGA mode (or worse, text mode), we need to do some VGA black
2530 * magic here that I know nothing about. --BenH
2531 */
2532 radeon_write_mode (rinfo, &rinfo->init_state, 1);
2533 #endif
2534
2535 del_timer_sync(&rinfo->lvds_timer);
2536
2537 #ifdef CONFIG_MTRR
2538 if (rinfo->mtrr_hdl >= 0)
2539 mtrr_del(rinfo->mtrr_hdl, 0, 0);
2540 #endif
2541
2542 unregister_framebuffer(info);
2543
2544 iounmap(rinfo->mmio_base);
2545 iounmap(rinfo->fb_base);
2546
2547 pci_release_regions(pdev);
2548
2549 kfree(rinfo->mon1_EDID);
2550 kfree(rinfo->mon2_EDID);
2551 if (rinfo->mon1_modedb)
2552 fb_destroy_modedb(rinfo->mon1_modedb);
2553 #ifdef CONFIG_FB_RADEON_I2C
2554 radeon_delete_i2c_busses(rinfo);
2555 #endif
2556 fb_dealloc_cmap(&info->cmap);
2557 framebuffer_release(info);
2558 pci_disable_device(pdev);
2559 }
2560
2561
2562 static struct pci_driver radeonfb_driver = {
2563 .name = "radeonfb",
2564 .id_table = radeonfb_pci_table,
2565 .probe = radeonfb_pci_register,
2566 .remove = __devexit_p(radeonfb_pci_unregister),
2567 #ifdef CONFIG_PM
2568 .suspend = radeonfb_pci_suspend,
2569 .resume = radeonfb_pci_resume,
2570 #endif /* CONFIG_PM */
2571 };
2572
2573 #ifndef MODULE
2574 static int __init radeonfb_setup (char *options)
2575 {
2576 char *this_opt;
2577
2578 if (!options || !*options)
2579 return 0;
2580
2581 while ((this_opt = strsep (&options, ",")) != NULL) {
2582 if (!*this_opt)
2583 continue;
2584
2585 if (!strncmp(this_opt, "noaccel", 7)) {
2586 noaccel = 1;
2587 } else if (!strncmp(this_opt, "mirror", 6)) {
2588 mirror = 1;
2589 } else if (!strncmp(this_opt, "force_dfp", 9)) {
2590 force_dfp = 1;
2591 } else if (!strncmp(this_opt, "panel_yres:", 11)) {
2592 panel_yres = simple_strtoul((this_opt+11), NULL, 0);
2593 #ifdef CONFIG_MTRR
2594 } else if (!strncmp(this_opt, "nomtrr", 6)) {
2595 nomtrr = 1;
2596 #endif
2597 } else if (!strncmp(this_opt, "nomodeset", 9)) {
2598 nomodeset = 1;
2599 } else if (!strncmp(this_opt, "force_measure_pll", 17)) {
2600 force_measure_pll = 1;
2601 } else if (!strncmp(this_opt, "ignore_edid", 11)) {
2602 ignore_edid = 1;
2603 } else
2604 mode_option = this_opt;
2605 }
2606 return 0;
2607 }
2608 #endif /* MODULE */
2609
2610 static int __init radeonfb_init (void)
2611 {
2612 #ifndef MODULE
2613 char *option = NULL;
2614
2615 if (fb_get_options("radeonfb", &option))
2616 return -ENODEV;
2617 radeonfb_setup(option);
2618 #endif
2619 return pci_register_driver (&radeonfb_driver);
2620 }
2621
2622
2623 static void __exit radeonfb_exit (void)
2624 {
2625 pci_unregister_driver (&radeonfb_driver);
2626 }
2627
2628 module_init(radeonfb_init);
2629 module_exit(radeonfb_exit);
2630
2631 MODULE_AUTHOR("Ani Joshi");
2632 MODULE_DESCRIPTION("framebuffer driver for ATI Radeon chipset");
2633 MODULE_LICENSE("GPL");
2634 module_param(noaccel, bool, 0);
2635 module_param(default_dynclk, int, 0);
2636 MODULE_PARM_DESC(default_dynclk, "int: -2=enable on mobility only,-1=do not change,0=off,1=on");
2637 MODULE_PARM_DESC(noaccel, "bool: disable acceleration");
2638 module_param(nomodeset, bool, 0);
2639 MODULE_PARM_DESC(nomodeset, "bool: disable actual setting of video mode");
2640 module_param(mirror, bool, 0);
2641 MODULE_PARM_DESC(mirror, "bool: mirror the display to both monitors");
2642 module_param(force_dfp, bool, 0);
2643 MODULE_PARM_DESC(force_dfp, "bool: force display to dfp");
2644 module_param(ignore_edid, bool, 0);
2645 MODULE_PARM_DESC(ignore_edid, "bool: Ignore EDID data when doing DDC probe");
2646 module_param(monitor_layout, charp, 0);
2647 MODULE_PARM_DESC(monitor_layout, "Specify monitor mapping (like XFree86)");
2648 module_param(force_measure_pll, bool, 0);
2649 MODULE_PARM_DESC(force_measure_pll, "Force measurement of PLL (debug)");
2650 #ifdef CONFIG_MTRR
2651 module_param(nomtrr, bool, 0);
2652 MODULE_PARM_DESC(nomtrr, "bool: disable use of MTRR registers");
2653 #endif
2654 module_param(panel_yres, int, 0);
2655 MODULE_PARM_DESC(panel_yres, "int: set panel yres");
2656 module_param(mode_option, charp, 0);
2657 MODULE_PARM_DESC(mode_option, "Specify resolution as \"<xres>x<yres>[-<bpp>][@<refresh>]\" ");
Linus' kernel tree