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