Merge master.kernel.org:/pub/scm/linux/kernel/git/davem/sparc-2.6
[linux-2.6] / drivers / video / i810 / i810_gtf.c
1 /*-*- linux-c -*-
2  *  linux/drivers/video/i810_main.h -- Intel 810 Non-discrete Video Timings 
3  *                                     (VESA GTF)
4  *
5  *      Copyright (C) 2001 Antonino Daplas<adaplas@pol.net>
6  *      All Rights Reserved      
7  *
8  *
9  *  This file is subject to the terms and conditions of the GNU General Public
10  *  License. See the file COPYING in the main directory of this archive for
11  *  more details.
12  */
13 #include <linux/kernel.h>
14
15 #include "i810_regs.h"
16 #include "i810.h"
17
18 /*
19  * FIFO and Watermark tables - based almost wholly on i810_wmark.c in 
20  * XFree86 v4.03 by Precision Insight.  Slightly modified for integer 
21  * operation, instead of float
22  */
23
24 struct wm_info {
25    u32 freq;
26    u32  wm;
27 };
28
29 static struct wm_info i810_wm_8_100[] = {
30         { 15, 0x0070c000 },  { 19, 0x0070c000 },  { 25, 0x22003000 },
31         { 28, 0x22003000 },  { 31, 0x22003000 },  { 36, 0x22007000 },
32         { 40, 0x22007000 },  { 45, 0x22007000 },  { 49, 0x22008000 },
33         { 50, 0x22008000 },  { 56, 0x22008000 },  { 65, 0x22008000 },
34         { 75, 0x22008000 },  { 78, 0x22008000 },  { 80, 0x22008000 },
35         { 94, 0x22008000 },  { 96, 0x22107000 },  { 99, 0x22107000 },
36         { 108, 0x22107000 }, { 121, 0x22107000 }, { 128, 0x22107000 },
37         { 132, 0x22109000 }, { 135, 0x22109000 }, { 157, 0x2210b000 },
38         { 162, 0x2210b000 }, { 175, 0x2210b000 }, { 189, 0x2220e000 },
39         { 195, 0x2220e000 }, { 202, 0x2220e000 }, { 204, 0x2220e000 },
40         { 218, 0x2220f000 }, { 229, 0x22210000 }, { 234, 0x22210000 }, 
41 };
42
43 static struct wm_info i810_wm_16_100[] = {
44         { 15, 0x0070c000 },  { 19, 0x0020c000 },  { 25, 0x22006000 },
45         { 28, 0x22006000 },  { 31, 0x22007000 },  { 36, 0x22007000 },
46         { 40, 0x22007000 },  { 45, 0x22007000 },  { 49, 0x22009000 },
47         { 50, 0x22009000 },  { 56, 0x22108000 },  { 65, 0x2210e000 },
48         { 75, 0x2210e000 },  { 78, 0x2210e000 },  { 80, 0x22210000 },
49         { 94, 0x22210000 },  { 96, 0x22210000 },  { 99, 0x22210000 },
50         { 108, 0x22210000 }, { 121, 0x22210000 }, { 128, 0x22210000 },
51         { 132, 0x22314000 }, { 135, 0x22314000 }, { 157, 0x22415000 },
52         { 162, 0x22416000 }, { 175, 0x22416000 }, { 189, 0x22416000 },
53         { 195, 0x22416000 }, { 202, 0x22416000 }, { 204, 0x22416000 },
54         { 218, 0x22416000 }, { 229, 0x22416000 },
55 };
56
57 static struct wm_info i810_wm_24_100[] = {
58         { 15, 0x0020c000 },  { 19, 0x0040c000 },  { 25, 0x22009000 },
59         { 28, 0x22009000 },  { 31, 0x2200a000 },  { 36, 0x2210c000 },
60         { 40, 0x2210c000 },  { 45, 0x2210c000 },  { 49, 0x22111000 },
61         { 50, 0x22111000 },  { 56, 0x22111000 },  { 65, 0x22214000 },
62         { 75, 0x22214000 },  { 78, 0x22215000 },  { 80, 0x22216000 },
63         { 94, 0x22218000 },  { 96, 0x22418000 },  { 99, 0x22418000 },
64         { 108, 0x22418000 }, { 121, 0x22418000 }, { 128, 0x22419000 },
65         { 132, 0x22519000 }, { 135, 0x4441d000 }, { 157, 0x44419000 },
66         { 162, 0x44419000 }, { 175, 0x44419000 }, { 189, 0x44419000 },
67         { 195, 0x44419000 }, { 202, 0x44419000 }, { 204, 0x44419000 },
68 };
69
70 static struct wm_info i810_wm_8_133[] = {
71         { 15, 0x0070c000 },  { 19, 0x0070c000 },  { 25, 0x22003000 },
72         { 28, 0x22003000 },  { 31, 0x22003000 },  { 36, 0x22007000 },
73         { 40, 0x22007000 },  { 45, 0x22007000 },  { 49, 0x22008000 },
74         { 50, 0x22008000 },  { 56, 0x22008000 },  { 65, 0x22008000 },
75         { 75, 0x22008000 },  { 78, 0x22008000 },  { 80, 0x22008000 },
76         { 94, 0x22008000 },  { 96, 0x22107000 },  { 99, 0x22107000 },
77         { 108, 0x22107000 }, { 121, 0x22107000 }, { 128, 0x22107000 },
78         { 132, 0x22109000 }, { 135, 0x22109000 }, { 157, 0x2210b000 },
79         { 162, 0x2210b000 }, { 175, 0x2210b000 }, { 189, 0x2220e000 },
80         { 195, 0x2220e000 }, { 202, 0x2220e000 }, { 204, 0x2220e000 },
81         { 218, 0x2220f000 }, { 229, 0x22210000 }, { 234, 0x22210000 }, 
82 };
83
84 static struct wm_info i810_wm_16_133[] = {
85         { 15, 0x0020c000 },  { 19, 0x0020c000 },  { 25, 0x22006000 },
86         { 28, 0x22006000 },  { 31, 0x22007000 },  { 36, 0x22007000 },
87         { 40, 0x22007000 },  { 45, 0x22007000 },  { 49, 0x22009000 },
88         { 50, 0x22009000 },  { 56, 0x22108000 },  { 65, 0x2210e000 },
89         { 75, 0x2210e000 },  { 78, 0x2210e000 },  { 80, 0x22210000 },
90         { 94, 0x22210000 },  { 96, 0x22210000 },  { 99, 0x22210000 },
91         { 108, 0x22210000 }, { 121, 0x22210000 }, { 128, 0x22210000 },
92         { 132, 0x22314000 }, { 135, 0x22314000 }, { 157, 0x22415000 },
93         { 162, 0x22416000 }, { 175, 0x22416000 }, { 189, 0x22416000 },
94         { 195, 0x22416000 }, { 202, 0x22416000 }, { 204, 0x22416000 },
95         { 218, 0x22416000 }, { 229, 0x22416000 },
96 };
97
98 static struct wm_info i810_wm_24_133[] = {
99         { 15, 0x0020c000 },  { 19, 0x00408000 },  { 25, 0x22009000 },
100         { 28, 0x22009000 },  { 31, 0x2200a000 },  { 36, 0x2210c000 },
101         { 40, 0x2210c000 },  { 45, 0x2210c000 },  { 49, 0x22111000 },
102         { 50, 0x22111000 },  { 56, 0x22111000 },  { 65, 0x22214000 },
103         { 75, 0x22214000 },  { 78, 0x22215000 },  { 80, 0x22216000 },
104         { 94, 0x22218000 },  { 96, 0x22418000 },  { 99, 0x22418000 },
105         { 108, 0x22418000 }, { 121, 0x22418000 }, { 128, 0x22419000 },
106         { 132, 0x22519000 }, { 135, 0x4441d000 }, { 157, 0x44419000 },
107         { 162, 0x44419000 }, { 175, 0x44419000 }, { 189, 0x44419000 },
108         { 195, 0x44419000 }, { 202, 0x44419000 }, { 204, 0x44419000 },
109 };
110
111 void round_off_xres(u32 *xres) { }
112 void round_off_yres(u32 *xres, u32 *yres) { }
113
114 /**
115  * i810fb_encode_registers - encode @var to hardware register values
116  * @var: pointer to var structure
117  * @par: pointer to hardware par structure
118  * 
119  * DESCRIPTION: 
120  * Timing values in @var will be converted to appropriate
121  * register values of @par.  
122  */
123 void i810fb_encode_registers(const struct fb_var_screeninfo *var,
124                              struct i810fb_par *par, u32 xres, u32 yres)
125 {
126         int n, blank_s, blank_e;
127         u8 __iomem *mmio = par->mmio_start_virtual;
128         u8 msr = 0;
129
130         /* Horizontal */
131         /* htotal */
132         n = ((xres + var->right_margin + var->hsync_len + 
133               var->left_margin) >> 3) - 5;
134         par->regs.cr00 =  (u8) n;
135         par->regs.cr35 = (u8) ((n >> 8) & 1);
136         
137         /* xres */
138         par->regs.cr01 = (u8) ((xres >> 3) - 1);
139
140         /* hblank */
141         blank_e = (xres + var->right_margin + var->hsync_len + 
142                    var->left_margin) >> 3;
143         blank_e--;
144         blank_s = blank_e - 127;
145         if (blank_s < (xres >> 3))
146                 blank_s = xres >> 3;
147         par->regs.cr02 = (u8) blank_s;
148         par->regs.cr03 = (u8) (blank_e & 0x1F);
149         par->regs.cr05 = (u8) ((blank_e & (1 << 5)) << 2);
150         par->regs.cr39 = (u8) ((blank_e >> 6) & 1);
151
152         /* hsync */
153         par->regs.cr04 = (u8) ((xres + var->right_margin) >> 3);
154         par->regs.cr05 |= (u8) (((xres + var->right_margin + 
155                                   var->hsync_len) >> 3) & 0x1F);
156         
157         /* Vertical */
158         /* vtotal */
159         n = yres + var->lower_margin + var->vsync_len + var->upper_margin - 2;
160         par->regs.cr06 = (u8) (n & 0xFF);
161         par->regs.cr30 = (u8) ((n >> 8) & 0x0F);
162
163         /* vsync */ 
164         n = yres + var->lower_margin;
165         par->regs.cr10 = (u8) (n & 0xFF);
166         par->regs.cr32 = (u8) ((n >> 8) & 0x0F);
167         par->regs.cr11 = i810_readb(CR11, mmio) & ~0x0F;
168         par->regs.cr11 |= (u8) ((yres + var->lower_margin + 
169                                  var->vsync_len) & 0x0F);
170
171         /* yres */
172         n = yres - 1;
173         par->regs.cr12 = (u8) (n & 0xFF);
174         par->regs.cr31 = (u8) ((n >> 8) & 0x0F);
175         
176         /* vblank */
177         blank_e = yres + var->lower_margin + var->vsync_len + 
178                 var->upper_margin;
179         blank_e--;
180         blank_s = blank_e - 127;
181         if (blank_s < yres)
182                 blank_s = yres;
183         par->regs.cr15 = (u8) (blank_s & 0xFF);
184         par->regs.cr33 = (u8) ((blank_s >> 8) & 0x0F);
185         par->regs.cr16 = (u8) (blank_e & 0xFF);
186         par->regs.cr09 = 0;     
187
188         /* sync polarity */
189         if (!(var->sync & FB_SYNC_HOR_HIGH_ACT))
190                 msr |= 1 << 6;
191         if (!(var->sync & FB_SYNC_VERT_HIGH_ACT))
192                 msr |= 1 << 7;
193         par->regs.msr = msr;
194
195         /* interlace */
196         if (var->vmode & FB_VMODE_INTERLACED) 
197                 par->interlace = (1 << 7) | ((u8) (var->yres >> 4));
198         else 
199                 par->interlace = 0;
200
201         if (var->vmode & FB_VMODE_DOUBLE)
202                 par->regs.cr09 |= 1 << 7;
203
204         /* overlay */
205         par->ovract = ((var->xres + var->right_margin + var->hsync_len + 
206                         var->left_margin - 32) | ((var->xres - 32) << 16));
207 }       
208
209 void i810fb_fill_var_timings(struct fb_var_screeninfo *var) { }
210
211 /**
212  * i810_get_watermark - gets watermark
213  * @var: pointer to fb_var_screeninfo
214  * @par: pointer to i810fb_par structure
215  *
216  * DESCRIPTION:
217  * Gets the required watermark based on 
218  * pixelclock and RAMBUS frequency.
219  * 
220  * RETURNS:
221  * watermark
222  */
223 u32 i810_get_watermark(const struct fb_var_screeninfo *var,
224                        struct i810fb_par *par)
225 {
226         struct wm_info *wmark = NULL;
227         u32 i, size = 0, pixclock, wm_best = 0, min, diff;
228
229         if (par->mem_freq == 100) {
230                 switch (var->bits_per_pixel) { 
231                 case 8:
232                         wmark = i810_wm_8_100;
233                         size = ARRAY_SIZE(i810_wm_8_100);
234                         break;
235                 case 16:
236                         wmark = i810_wm_16_100;
237                         size = ARRAY_SIZE(i810_wm_16_100);
238                         break;
239                 case 24:
240                 case 32:
241                         wmark = i810_wm_24_100;
242                         size = ARRAY_SIZE(i810_wm_24_100);
243                 }
244         } else {
245                 switch(var->bits_per_pixel) {
246                 case 8:
247                         wmark = i810_wm_8_133;
248                         size = ARRAY_SIZE(i810_wm_8_133);
249                         break;
250                 case 16:
251                         wmark = i810_wm_16_133;
252                         size = ARRAY_SIZE(i810_wm_16_133);
253                         break;
254                 case 24:
255                 case 32:
256                         wmark = i810_wm_24_133;
257                         size = ARRAY_SIZE(i810_wm_24_133);
258                 }
259         }
260
261         pixclock = 1000000/var->pixclock;
262         min = ~0;
263         for (i = 0; i < size; i++) {
264                 if (pixclock <= wmark[i].freq) 
265                         diff = wmark[i].freq - pixclock;
266                 else 
267                         diff = pixclock - wmark[i].freq;
268                 if (diff < min) {
269                         wm_best = wmark[i].wm;
270                         min = diff;
271                 }
272         }
273         return wm_best;         
274 }       
275