1 /*
2 * Silicon Motion SM7XX frame buffer device
3 *
4 * Copyright (C) 2006 Silicon Motion Technology Corp.
5 * Authors: Ge Wang, gewang@siliconmotion.com
6 * Boyod boyod.yang@siliconmotion.com.cn
7 *
8 * Copyright (C) 2009 Lemote, Inc.
9 * Author: Wu Zhangjin, wuzhangjin@gmail.com
10 *
11 * Copyright (C) 2011 Igalia, S.L.
12 * Author: Javier M. Mellid <jmunhoz@igalia.com>
13 *
14 * This file is subject to the terms and conditions of the GNU General Public
15 * License. See the file COPYING in the main directory of this archive for
16 * more details.
17 *
18 * Framebuffer driver for Silicon Motion SM710, SM712, SM721 and SM722 chips
19 */
20
21 #include <linux/aperture.h>
22 #include <linux/io.h>
23 #include <linux/fb.h>
24 #include <linux/pci.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/uaccess.h>
28 #include <linux/module.h>
29 #include <linux/console.h>
30 #include <linux/screen_info.h>
31
32 #include <linux/pm.h>
33
34 #include "sm712.h"
35
36 /*
37 * Private structure
38 */
39 struct smtcfb_info {
40 struct pci_dev *pdev;
41 struct fb_info *fb;
42 u16 chip_id;
43 u8 chip_rev_id;
44
45 void __iomem *lfb; /* linear frame buffer */
46 void __iomem *dp_regs; /* drawing processor control regs */
47 void __iomem *vp_regs; /* video processor control regs */
48 void __iomem *cp_regs; /* capture processor control regs */
49 void __iomem *mmio; /* memory map IO port */
50
51 u_int width;
52 u_int height;
53 u_int hz;
54
55 u32 colreg[17];
56 };
57
58 void __iomem *smtc_regbaseaddress; /* Memory Map IO starting address */
59
60 static const struct fb_var_screeninfo smtcfb_var = {
61 .xres = 1024,
62 .yres = 600,
63 .xres_virtual = 1024,
64 .yres_virtual = 600,
65 .bits_per_pixel = 16,
66 .red = {16, 8, 0},
67 .green = {8, 8, 0},
68 .blue = {0, 8, 0},
69 .activate = FB_ACTIVATE_NOW,
70 .height = -1,
71 .width = -1,
72 .vmode = FB_VMODE_NONINTERLACED,
73 .nonstd = 0,
74 .accel_flags = FB_ACCELF_TEXT,
75 };
76
77 static struct fb_fix_screeninfo smtcfb_fix = {
78 .id = "smXXXfb",
79 .type = FB_TYPE_PACKED_PIXELS,
80 .visual = FB_VISUAL_TRUECOLOR,
81 .line_length = 800 * 3,
82 .accel = FB_ACCEL_SMI_LYNX,
83 .type_aux = 0,
84 .xpanstep = 0,
85 .ypanstep = 0,
86 .ywrapstep = 0,
87 };
88
89 struct vesa_mode {
90 char index[6];
91 u16 lfb_width;
92 u16 lfb_height;
93 u16 lfb_depth;
94 };
95
96 static const struct vesa_mode vesa_mode_table[] = {
97 {"0x301", 640, 480, 8},
98 {"0x303", 800, 600, 8},
99 {"0x305", 1024, 768, 8},
100 {"0x307", 1280, 1024, 8},
101
102 {"0x311", 640, 480, 16},
103 {"0x314", 800, 600, 16},
104 {"0x317", 1024, 768, 16},
105 {"0x31A", 1280, 1024, 16},
106
107 {"0x312", 640, 480, 24},
108 {"0x315", 800, 600, 24},
109 {"0x318", 1024, 768, 24},
110 {"0x31B", 1280, 1024, 24},
111 };
112
113 /**********************************************************************
114 SM712 Mode table.
115 **********************************************************************/
116 static const struct modeinit vgamode[] = {
117 {
118 /* mode#0: 640 x 480 16Bpp 60Hz */
119 640, 480, 16, 60,
120 /* Init_MISC */
121 0xE3,
122 { /* Init_SR0_SR4 */
123 0x03, 0x01, 0x0F, 0x00, 0x0E,
124 },
125 { /* Init_SR10_SR24 */
126 0xFF, 0xBE, 0xEF, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
127 0x99, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
128 0xC4, 0x30, 0x02, 0x01, 0x01,
129 },
130 { /* Init_SR30_SR75 */
131 0x32, 0x03, 0xA0, 0x09, 0xC0, 0x32, 0x32, 0x32,
132 0x32, 0x32, 0x32, 0x32, 0x00, 0x00, 0x03, 0xFF,
133 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
134 0x20, 0x0C, 0x44, 0x20, 0x00, 0x32, 0x32, 0x32,
135 0x04, 0x24, 0x63, 0x4F, 0x52, 0x0B, 0xDF, 0xEA,
136 0x04, 0x50, 0x19, 0x32, 0x32, 0x00, 0x00, 0x32,
137 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
138 0x50, 0x03, 0x74, 0x14, 0x07, 0x82, 0x07, 0x04,
139 0x00, 0x45, 0x30, 0x30, 0x40, 0x30,
140 },
141 { /* Init_SR80_SR93 */
142 0xFF, 0x07, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x32,
143 0xF7, 0x00, 0x00, 0x00, 0xEF, 0xFF, 0x32, 0x32,
144 0x00, 0x00, 0x00, 0x00,
145 },
146 { /* Init_SRA0_SRAF */
147 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
148 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xFF, 0xDF,
149 },
150 { /* Init_GR00_GR08 */
151 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
152 0xFF,
153 },
154 { /* Init_AR00_AR14 */
155 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
156 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
157 0x41, 0x00, 0x0F, 0x00, 0x00,
158 },
159 { /* Init_CR00_CR18 */
160 0x5F, 0x4F, 0x4F, 0x00, 0x53, 0x1F, 0x0B, 0x3E,
161 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
162 0xEA, 0x0C, 0xDF, 0x50, 0x40, 0xDF, 0x00, 0xE3,
163 0xFF,
164 },
165 { /* Init_CR30_CR4D */
166 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x03, 0x20,
167 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xFF, 0xFD,
168 0x5F, 0x4F, 0x00, 0x54, 0x00, 0x0B, 0xDF, 0x00,
169 0xEA, 0x0C, 0x2E, 0x00, 0x4F, 0xDF,
170 },
171 { /* Init_CR90_CRA7 */
172 0x56, 0xDD, 0x5E, 0xEA, 0x87, 0x44, 0x8F, 0x55,
173 0x0A, 0x8F, 0x55, 0x0A, 0x00, 0x00, 0x18, 0x00,
174 0x11, 0x10, 0x0B, 0x0A, 0x0A, 0x0A, 0x0A, 0x00,
175 },
176 },
177 {
178 /* mode#1: 640 x 480 24Bpp 60Hz */
179 640, 480, 24, 60,
180 /* Init_MISC */
181 0xE3,
182 { /* Init_SR0_SR4 */
183 0x03, 0x01, 0x0F, 0x00, 0x0E,
184 },
185 { /* Init_SR10_SR24 */
186 0xFF, 0xBE, 0xEF, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
187 0x99, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
188 0xC4, 0x30, 0x02, 0x01, 0x01,
189 },
190 { /* Init_SR30_SR75 */
191 0x32, 0x03, 0xA0, 0x09, 0xC0, 0x32, 0x32, 0x32,
192 0x32, 0x32, 0x32, 0x32, 0x00, 0x00, 0x03, 0xFF,
193 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
194 0x20, 0x0C, 0x44, 0x20, 0x00, 0x32, 0x32, 0x32,
195 0x04, 0x24, 0x63, 0x4F, 0x52, 0x0B, 0xDF, 0xEA,
196 0x04, 0x50, 0x19, 0x32, 0x32, 0x00, 0x00, 0x32,
197 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
198 0x50, 0x03, 0x74, 0x14, 0x07, 0x82, 0x07, 0x04,
199 0x00, 0x45, 0x30, 0x30, 0x40, 0x30,
200 },
201 { /* Init_SR80_SR93 */
202 0xFF, 0x07, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x32,
203 0xF7, 0x00, 0x00, 0x00, 0xEF, 0xFF, 0x32, 0x32,
204 0x00, 0x00, 0x00, 0x00,
205 },
206 { /* Init_SRA0_SRAF */
207 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
208 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xFF, 0xDF,
209 },
210 { /* Init_GR00_GR08 */
211 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
212 0xFF,
213 },
214 { /* Init_AR00_AR14 */
215 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
216 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
217 0x41, 0x00, 0x0F, 0x00, 0x00,
218 },
219 { /* Init_CR00_CR18 */
220 0x5F, 0x4F, 0x4F, 0x00, 0x53, 0x1F, 0x0B, 0x3E,
221 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
222 0xEA, 0x0C, 0xDF, 0x50, 0x40, 0xDF, 0x00, 0xE3,
223 0xFF,
224 },
225 { /* Init_CR30_CR4D */
226 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x03, 0x20,
227 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xFF, 0xFD,
228 0x5F, 0x4F, 0x00, 0x54, 0x00, 0x0B, 0xDF, 0x00,
229 0xEA, 0x0C, 0x2E, 0x00, 0x4F, 0xDF,
230 },
231 { /* Init_CR90_CRA7 */
232 0x56, 0xDD, 0x5E, 0xEA, 0x87, 0x44, 0x8F, 0x55,
233 0x0A, 0x8F, 0x55, 0x0A, 0x00, 0x00, 0x18, 0x00,
234 0x11, 0x10, 0x0B, 0x0A, 0x0A, 0x0A, 0x0A, 0x00,
235 },
236 },
237 {
238 /* mode#0: 640 x 480 32Bpp 60Hz */
239 640, 480, 32, 60,
240 /* Init_MISC */
241 0xE3,
242 { /* Init_SR0_SR4 */
243 0x03, 0x01, 0x0F, 0x00, 0x0E,
244 },
245 { /* Init_SR10_SR24 */
246 0xFF, 0xBE, 0xEF, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
247 0x99, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
248 0xC4, 0x30, 0x02, 0x01, 0x01,
249 },
250 { /* Init_SR30_SR75 */
251 0x32, 0x03, 0xA0, 0x09, 0xC0, 0x32, 0x32, 0x32,
252 0x32, 0x32, 0x32, 0x32, 0x00, 0x00, 0x03, 0xFF,
253 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
254 0x20, 0x0C, 0x44, 0x20, 0x00, 0x32, 0x32, 0x32,
255 0x04, 0x24, 0x63, 0x4F, 0x52, 0x0B, 0xDF, 0xEA,
256 0x04, 0x50, 0x19, 0x32, 0x32, 0x00, 0x00, 0x32,
257 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
258 0x50, 0x03, 0x74, 0x14, 0x07, 0x82, 0x07, 0x04,
259 0x00, 0x45, 0x30, 0x30, 0x40, 0x30,
260 },
261 { /* Init_SR80_SR93 */
262 0xFF, 0x07, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x32,
263 0xF7, 0x00, 0x00, 0x00, 0xEF, 0xFF, 0x32, 0x32,
264 0x00, 0x00, 0x00, 0x00,
265 },
266 { /* Init_SRA0_SRAF */
267 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
268 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xFF, 0xDF,
269 },
270 { /* Init_GR00_GR08 */
271 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
272 0xFF,
273 },
274 { /* Init_AR00_AR14 */
275 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
276 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
277 0x41, 0x00, 0x0F, 0x00, 0x00,
278 },
279 { /* Init_CR00_CR18 */
280 0x5F, 0x4F, 0x4F, 0x00, 0x53, 0x1F, 0x0B, 0x3E,
281 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
282 0xEA, 0x0C, 0xDF, 0x50, 0x40, 0xDF, 0x00, 0xE3,
283 0xFF,
284 },
285 { /* Init_CR30_CR4D */
286 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x03, 0x20,
287 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xFF, 0xFD,
288 0x5F, 0x4F, 0x00, 0x54, 0x00, 0x0B, 0xDF, 0x00,
289 0xEA, 0x0C, 0x2E, 0x00, 0x4F, 0xDF,
290 },
291 { /* Init_CR90_CRA7 */
292 0x56, 0xDD, 0x5E, 0xEA, 0x87, 0x44, 0x8F, 0x55,
293 0x0A, 0x8F, 0x55, 0x0A, 0x00, 0x00, 0x18, 0x00,
294 0x11, 0x10, 0x0B, 0x0A, 0x0A, 0x0A, 0x0A, 0x00,
295 },
296 },
297
298 { /* mode#2: 800 x 600 16Bpp 60Hz */
299 800, 600, 16, 60,
300 /* Init_MISC */
301 0x2B,
302 { /* Init_SR0_SR4 */
303 0x03, 0x01, 0x0F, 0x03, 0x0E,
304 },
305 { /* Init_SR10_SR24 */
306 0xFF, 0xBE, 0xEE, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
307 0x99, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
308 0xC4, 0x30, 0x02, 0x01, 0x01,
309 },
310 { /* Init_SR30_SR75 */
311 0x34, 0x03, 0x20, 0x09, 0xC0, 0x24, 0x24, 0x24,
312 0x24, 0x24, 0x24, 0x24, 0x00, 0x00, 0x03, 0xFF,
313 0x00, 0xFC, 0x00, 0x00, 0x20, 0x38, 0x00, 0xFC,
314 0x20, 0x0C, 0x44, 0x20, 0x00, 0x24, 0x24, 0x24,
315 0x04, 0x48, 0x83, 0x63, 0x68, 0x72, 0x57, 0x58,
316 0x04, 0x55, 0x59, 0x24, 0x24, 0x00, 0x00, 0x24,
317 0x01, 0x80, 0x7A, 0x1A, 0x1A, 0x00, 0x00, 0x00,
318 0x50, 0x03, 0x74, 0x14, 0x1C, 0x85, 0x35, 0x13,
319 0x02, 0x45, 0x30, 0x35, 0x40, 0x20,
320 },
321 { /* Init_SR80_SR93 */
322 0x00, 0x00, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x24,
323 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x24, 0x24,
324 0x00, 0x00, 0x00, 0x00,
325 },
326 { /* Init_SRA0_SRAF */
327 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
328 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xBF, 0xDF,
329 },
330 { /* Init_GR00_GR08 */
331 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
332 0xFF,
333 },
334 { /* Init_AR00_AR14 */
335 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
336 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
337 0x41, 0x00, 0x0F, 0x00, 0x00,
338 },
339 { /* Init_CR00_CR18 */
340 0x7F, 0x63, 0x63, 0x00, 0x68, 0x18, 0x72, 0xF0,
341 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
342 0x58, 0x0C, 0x57, 0x64, 0x40, 0x57, 0x00, 0xE3,
343 0xFF,
344 },
345 { /* Init_CR30_CR4D */
346 0x00, 0x00, 0x00, 0x00, 0x00, 0x33, 0x03, 0x20,
347 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xBF, 0xFD,
348 0x7F, 0x63, 0x00, 0x69, 0x18, 0x72, 0x57, 0x00,
349 0x58, 0x0C, 0xE0, 0x20, 0x63, 0x57,
350 },
351 { /* Init_CR90_CRA7 */
352 0x56, 0x4B, 0x5E, 0x55, 0x86, 0x9D, 0x8E, 0xAA,
353 0xDB, 0x2A, 0xDF, 0x33, 0x00, 0x00, 0x18, 0x00,
354 0x20, 0x1F, 0x1A, 0x19, 0x0F, 0x0F, 0x0F, 0x00,
355 },
356 },
357 { /* mode#3: 800 x 600 24Bpp 60Hz */
358 800, 600, 24, 60,
359 0x2B,
360 { /* Init_SR0_SR4 */
361 0x03, 0x01, 0x0F, 0x03, 0x0E,
362 },
363 { /* Init_SR10_SR24 */
364 0xFF, 0xBE, 0xEE, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
365 0x99, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
366 0xC4, 0x30, 0x02, 0x01, 0x01,
367 },
368 { /* Init_SR30_SR75 */
369 0x36, 0x03, 0x20, 0x09, 0xC0, 0x36, 0x36, 0x36,
370 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x03, 0xFF,
371 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
372 0x20, 0x0C, 0x44, 0x20, 0x00, 0x36, 0x36, 0x36,
373 0x04, 0x48, 0x83, 0x63, 0x68, 0x72, 0x57, 0x58,
374 0x04, 0x55, 0x59, 0x36, 0x36, 0x00, 0x00, 0x36,
375 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
376 0x50, 0x03, 0x74, 0x14, 0x1C, 0x85, 0x35, 0x13,
377 0x02, 0x45, 0x30, 0x30, 0x40, 0x20,
378 },
379 { /* Init_SR80_SR93 */
380 0xFF, 0x07, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x36,
381 0xF7, 0x00, 0x00, 0x00, 0xEF, 0xFF, 0x36, 0x36,
382 0x00, 0x00, 0x00, 0x00,
383 },
384 { /* Init_SRA0_SRAF */
385 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
386 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xBF, 0xDF,
387 },
388 { /* Init_GR00_GR08 */
389 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
390 0xFF,
391 },
392 { /* Init_AR00_AR14 */
393 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
394 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
395 0x41, 0x00, 0x0F, 0x00, 0x00,
396 },
397 { /* Init_CR00_CR18 */
398 0x7F, 0x63, 0x63, 0x00, 0x68, 0x18, 0x72, 0xF0,
399 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
400 0x58, 0x0C, 0x57, 0x64, 0x40, 0x57, 0x00, 0xE3,
401 0xFF,
402 },
403 { /* Init_CR30_CR4D */
404 0x00, 0x00, 0x00, 0x00, 0x00, 0x33, 0x03, 0x20,
405 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xBF, 0xFD,
406 0x7F, 0x63, 0x00, 0x69, 0x18, 0x72, 0x57, 0x00,
407 0x58, 0x0C, 0xE0, 0x20, 0x63, 0x57,
408 },
409 { /* Init_CR90_CRA7 */
410 0x56, 0x4B, 0x5E, 0x55, 0x86, 0x9D, 0x8E, 0xAA,
411 0xDB, 0x2A, 0xDF, 0x33, 0x00, 0x00, 0x18, 0x00,
412 0x20, 0x1F, 0x1A, 0x19, 0x0F, 0x0F, 0x0F, 0x00,
413 },
414 },
415 { /* mode#7: 800 x 600 32Bpp 60Hz */
416 800, 600, 32, 60,
417 /* Init_MISC */
418 0x2B,
419 { /* Init_SR0_SR4 */
420 0x03, 0x01, 0x0F, 0x03, 0x0E,
421 },
422 { /* Init_SR10_SR24 */
423 0xFF, 0xBE, 0xEE, 0xFF, 0x00, 0x0E, 0x17, 0x2C,
424 0x99, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
425 0xC4, 0x30, 0x02, 0x01, 0x01,
426 },
427 { /* Init_SR30_SR75 */
428 0x34, 0x03, 0x20, 0x09, 0xC0, 0x24, 0x24, 0x24,
429 0x24, 0x24, 0x24, 0x24, 0x00, 0x00, 0x03, 0xFF,
430 0x00, 0xFC, 0x00, 0x00, 0x20, 0x38, 0x00, 0xFC,
431 0x20, 0x0C, 0x44, 0x20, 0x00, 0x24, 0x24, 0x24,
432 0x04, 0x48, 0x83, 0x63, 0x68, 0x72, 0x57, 0x58,
433 0x04, 0x55, 0x59, 0x24, 0x24, 0x00, 0x00, 0x24,
434 0x01, 0x80, 0x7A, 0x1A, 0x1A, 0x00, 0x00, 0x00,
435 0x50, 0x03, 0x74, 0x14, 0x1C, 0x85, 0x35, 0x13,
436 0x02, 0x45, 0x30, 0x35, 0x40, 0x20,
437 },
438 { /* Init_SR80_SR93 */
439 0x00, 0x00, 0x00, 0x6F, 0x7F, 0x7F, 0xFF, 0x24,
440 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x24, 0x24,
441 0x00, 0x00, 0x00, 0x00,
442 },
443 { /* Init_SRA0_SRAF */
444 0x00, 0xFF, 0xBF, 0xFF, 0xFF, 0xED, 0xED, 0xED,
445 0x7B, 0xFF, 0xFF, 0xFF, 0xBF, 0xEF, 0xBF, 0xDF,
446 },
447 { /* Init_GR00_GR08 */
448 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
449 0xFF,
450 },
451 { /* Init_AR00_AR14 */
452 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
453 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
454 0x41, 0x00, 0x0F, 0x00, 0x00,
455 },
456 { /* Init_CR00_CR18 */
457 0x7F, 0x63, 0x63, 0x00, 0x68, 0x18, 0x72, 0xF0,
458 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
459 0x58, 0x0C, 0x57, 0x64, 0x40, 0x57, 0x00, 0xE3,
460 0xFF,
461 },
462 { /* Init_CR30_CR4D */
463 0x00, 0x00, 0x00, 0x00, 0x00, 0x33, 0x03, 0x20,
464 0x00, 0x00, 0x00, 0x40, 0x00, 0xE7, 0xBF, 0xFD,
465 0x7F, 0x63, 0x00, 0x69, 0x18, 0x72, 0x57, 0x00,
466 0x58, 0x0C, 0xE0, 0x20, 0x63, 0x57,
467 },
468 { /* Init_CR90_CRA7 */
469 0x56, 0x4B, 0x5E, 0x55, 0x86, 0x9D, 0x8E, 0xAA,
470 0xDB, 0x2A, 0xDF, 0x33, 0x00, 0x00, 0x18, 0x00,
471 0x20, 0x1F, 0x1A, 0x19, 0x0F, 0x0F, 0x0F, 0x00,
472 },
473 },
474 /* We use 1024x768 table to light 1024x600 panel for lemote */
475 { /* mode#4: 1024 x 600 16Bpp 60Hz */
476 1024, 600, 16, 60,
477 /* Init_MISC */
478 0xEB,
479 { /* Init_SR0_SR4 */
480 0x03, 0x01, 0x0F, 0x00, 0x0E,
481 },
482 { /* Init_SR10_SR24 */
483 0xC8, 0x40, 0x14, 0x60, 0x00, 0x0A, 0x17, 0x20,
484 0x51, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
485 0xC4, 0x30, 0x02, 0x00, 0x01,
486 },
487 { /* Init_SR30_SR75 */
488 0x22, 0x03, 0x24, 0x09, 0xC0, 0x22, 0x22, 0x22,
489 0x22, 0x22, 0x22, 0x22, 0x00, 0x00, 0x03, 0xFF,
490 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
491 0x20, 0x0C, 0x44, 0x20, 0x00, 0x22, 0x22, 0x22,
492 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
493 0x00, 0x60, 0x59, 0x22, 0x22, 0x00, 0x00, 0x22,
494 0x01, 0x80, 0x7A, 0x1A, 0x1A, 0x00, 0x00, 0x00,
495 0x50, 0x03, 0x16, 0x02, 0x0D, 0x82, 0x09, 0x02,
496 0x04, 0x45, 0x3F, 0x30, 0x40, 0x20,
497 },
498 { /* Init_SR80_SR93 */
499 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
500 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
501 0x00, 0x00, 0x00, 0x00,
502 },
503 { /* Init_SRA0_SRAF */
504 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
505 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
506 },
507 { /* Init_GR00_GR08 */
508 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
509 0xFF,
510 },
511 { /* Init_AR00_AR14 */
512 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
513 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
514 0x41, 0x00, 0x0F, 0x00, 0x00,
515 },
516 { /* Init_CR00_CR18 */
517 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
518 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
519 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
520 0xFF,
521 },
522 { /* Init_CR30_CR4D */
523 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
524 0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
525 0xA3, 0x7F, 0x00, 0x82, 0x0b, 0x6f, 0x57, 0x00,
526 0x5c, 0x0f, 0xE0, 0xe0, 0x7F, 0x57,
527 },
528 { /* Init_CR90_CRA7 */
529 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
530 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
531 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
532 },
533 },
534 { /* 1024 x 768 16Bpp 60Hz */
535 1024, 768, 16, 60,
536 /* Init_MISC */
537 0xEB,
538 { /* Init_SR0_SR4 */
539 0x03, 0x01, 0x0F, 0x03, 0x0E,
540 },
541 { /* Init_SR10_SR24 */
542 0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
543 0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
544 0xC4, 0x30, 0x02, 0x01, 0x01,
545 },
546 { /* Init_SR30_SR75 */
547 0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
548 0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
549 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
550 0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
551 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
552 0x0F, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
553 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
554 0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
555 0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
556 },
557 { /* Init_SR80_SR93 */
558 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
559 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
560 0x00, 0x00, 0x00, 0x00,
561 },
562 { /* Init_SRA0_SRAF */
563 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
564 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
565 },
566 { /* Init_GR00_GR08 */
567 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
568 0xFF,
569 },
570 { /* Init_AR00_AR14 */
571 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
572 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
573 0x41, 0x00, 0x0F, 0x00, 0x00,
574 },
575 { /* Init_CR00_CR18 */
576 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
577 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
578 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
579 0xFF,
580 },
581 { /* Init_CR30_CR4D */
582 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
583 0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
584 0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
585 0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
586 },
587 { /* Init_CR90_CRA7 */
588 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
589 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
590 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
591 },
592 },
593 { /* mode#5: 1024 x 768 24Bpp 60Hz */
594 1024, 768, 24, 60,
595 /* Init_MISC */
596 0xEB,
597 { /* Init_SR0_SR4 */
598 0x03, 0x01, 0x0F, 0x03, 0x0E,
599 },
600 { /* Init_SR10_SR24 */
601 0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
602 0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
603 0xC4, 0x30, 0x02, 0x01, 0x01,
604 },
605 { /* Init_SR30_SR75 */
606 0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
607 0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
608 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
609 0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
610 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
611 0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
612 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
613 0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
614 0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
615 },
616 { /* Init_SR80_SR93 */
617 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
618 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
619 0x00, 0x00, 0x00, 0x00,
620 },
621 { /* Init_SRA0_SRAF */
622 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
623 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
624 },
625 { /* Init_GR00_GR08 */
626 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
627 0xFF,
628 },
629 { /* Init_AR00_AR14 */
630 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
631 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
632 0x41, 0x00, 0x0F, 0x00, 0x00,
633 },
634 { /* Init_CR00_CR18 */
635 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
636 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
637 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
638 0xFF,
639 },
640 { /* Init_CR30_CR4D */
641 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
642 0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
643 0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
644 0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
645 },
646 { /* Init_CR90_CRA7 */
647 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
648 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
649 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
650 },
651 },
652 { /* mode#4: 1024 x 768 32Bpp 60Hz */
653 1024, 768, 32, 60,
654 /* Init_MISC */
655 0xEB,
656 { /* Init_SR0_SR4 */
657 0x03, 0x01, 0x0F, 0x03, 0x0E,
658 },
659 { /* Init_SR10_SR24 */
660 0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
661 0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
662 0xC4, 0x32, 0x02, 0x01, 0x01,
663 },
664 { /* Init_SR30_SR75 */
665 0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
666 0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
667 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
668 0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
669 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
670 0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
671 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
672 0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
673 0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
674 },
675 { /* Init_SR80_SR93 */
676 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
677 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
678 0x00, 0x00, 0x00, 0x00,
679 },
680 { /* Init_SRA0_SRAF */
681 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
682 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
683 },
684 { /* Init_GR00_GR08 */
685 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
686 0xFF,
687 },
688 { /* Init_AR00_AR14 */
689 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
690 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
691 0x41, 0x00, 0x0F, 0x00, 0x00,
692 },
693 { /* Init_CR00_CR18 */
694 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
695 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
696 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
697 0xFF,
698 },
699 { /* Init_CR30_CR4D */
700 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
701 0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
702 0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
703 0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
704 },
705 { /* Init_CR90_CRA7 */
706 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
707 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
708 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
709 },
710 },
711 { /* mode#6: 320 x 240 16Bpp 60Hz */
712 320, 240, 16, 60,
713 /* Init_MISC */
714 0xEB,
715 { /* Init_SR0_SR4 */
716 0x03, 0x01, 0x0F, 0x03, 0x0E,
717 },
718 { /* Init_SR10_SR24 */
719 0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
720 0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
721 0xC4, 0x32, 0x02, 0x01, 0x01,
722 },
723 { /* Init_SR30_SR75 */
724 0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
725 0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
726 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
727 0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
728 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
729 0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
730 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
731 0x50, 0x03, 0x74, 0x14, 0x08, 0x43, 0x08, 0x43,
732 0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
733 },
734 { /* Init_SR80_SR93 */
735 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
736 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
737 0x00, 0x00, 0x00, 0x00,
738 },
739 { /* Init_SRA0_SRAF */
740 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
741 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
742 },
743 { /* Init_GR00_GR08 */
744 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
745 0xFF,
746 },
747 { /* Init_AR00_AR14 */
748 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
749 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
750 0x41, 0x00, 0x0F, 0x00, 0x00,
751 },
752 { /* Init_CR00_CR18 */
753 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
754 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
755 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
756 0xFF,
757 },
758 { /* Init_CR30_CR4D */
759 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
760 0x00, 0x00, 0x30, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
761 0x2E, 0x27, 0x00, 0x2b, 0x0c, 0x0F, 0xEF, 0x00,
762 0xFe, 0x0f, 0x01, 0xC0, 0x27, 0xEF,
763 },
764 { /* Init_CR90_CRA7 */
765 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
766 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
767 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
768 },
769 },
770
771 { /* mode#8: 320 x 240 32Bpp 60Hz */
772 320, 240, 32, 60,
773 /* Init_MISC */
774 0xEB,
775 { /* Init_SR0_SR4 */
776 0x03, 0x01, 0x0F, 0x03, 0x0E,
777 },
778 { /* Init_SR10_SR24 */
779 0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
780 0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
781 0xC4, 0x32, 0x02, 0x01, 0x01,
782 },
783 { /* Init_SR30_SR75 */
784 0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
785 0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
786 0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
787 0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
788 0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
789 0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
790 0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
791 0x50, 0x03, 0x74, 0x14, 0x08, 0x43, 0x08, 0x43,
792 0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
793 },
794 { /* Init_SR80_SR93 */
795 0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
796 0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
797 0x00, 0x00, 0x00, 0x00,
798 },
799 { /* Init_SRA0_SRAF */
800 0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
801 0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
802 },
803 { /* Init_GR00_GR08 */
804 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
805 0xFF,
806 },
807 { /* Init_AR00_AR14 */
808 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
809 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
810 0x41, 0x00, 0x0F, 0x00, 0x00,
811 },
812 { /* Init_CR00_CR18 */
813 0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
814 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
815 0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
816 0xFF,
817 },
818 { /* Init_CR30_CR4D */
819 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
820 0x00, 0x00, 0x30, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
821 0x2E, 0x27, 0x00, 0x2b, 0x0c, 0x0F, 0xEF, 0x00,
822 0xFe, 0x0f, 0x01, 0xC0, 0x27, 0xEF,
823 },
824 { /* Init_CR90_CRA7 */
825 0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
826 0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
827 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
828 },
829 },
830 };
831
832 static struct screen_info smtc_scr_info;
833
834 static char *mode_option;
835
836 /* process command line options, get vga parameter */
sm7xx_vga_setup(char * options)837 static void __init sm7xx_vga_setup(char *options)
838 {
839 int i;
840
841 if (!options || !*options)
842 return;
843
844 smtc_scr_info.lfb_width = 0;
845 smtc_scr_info.lfb_height = 0;
846 smtc_scr_info.lfb_depth = 0;
847
848 pr_debug("%s = %s\n", __func__, options);
849
850 for (i = 0; i < ARRAY_SIZE(vesa_mode_table); i++) {
851 if (strstr(options, vesa_mode_table[i].index)) {
852 smtc_scr_info.lfb_width = vesa_mode_table[i].lfb_width;
853 smtc_scr_info.lfb_height =
854 vesa_mode_table[i].lfb_height;
855 smtc_scr_info.lfb_depth = vesa_mode_table[i].lfb_depth;
856 return;
857 }
858 }
859 }
860
sm712_setpalette(int regno,unsigned int red,unsigned int green,unsigned int blue,struct fb_info * info)861 static void sm712_setpalette(int regno, unsigned int red, unsigned int green,
862 unsigned int blue, struct fb_info *info)
863 {
864 /* set bit 5:4 = 01 (write LCD RAM only) */
865 smtc_seqw(0x66, (smtc_seqr(0x66) & 0xC3) | 0x10);
866
867 smtc_mmiowb(regno, dac_reg);
868 smtc_mmiowb(red >> 10, dac_val);
869 smtc_mmiowb(green >> 10, dac_val);
870 smtc_mmiowb(blue >> 10, dac_val);
871 }
872
873 /* chan_to_field
874 *
875 * convert a colour value into a field position
876 *
877 * from pxafb.c
878 */
879
chan_to_field(unsigned int chan,struct fb_bitfield * bf)880 static inline unsigned int chan_to_field(unsigned int chan,
881 struct fb_bitfield *bf)
882 {
883 chan &= 0xffff;
884 chan >>= 16 - bf->length;
885 return chan << bf->offset;
886 }
887
smtc_blank(int blank_mode,struct fb_info * info)888 static int smtc_blank(int blank_mode, struct fb_info *info)
889 {
890 struct smtcfb_info *sfb = info->par;
891
892 /* clear DPMS setting */
893 switch (blank_mode) {
894 case FB_BLANK_UNBLANK:
895 /* Screen On: HSync: On, VSync : On */
896
897 switch (sfb->chip_id) {
898 case 0x710:
899 case 0x712:
900 smtc_seqw(0x6a, 0x16);
901 smtc_seqw(0x6b, 0x02);
902 break;
903 case 0x720:
904 smtc_seqw(0x6a, 0x0d);
905 smtc_seqw(0x6b, 0x02);
906 break;
907 }
908
909 smtc_seqw(0x23, (smtc_seqr(0x23) & (~0xc0)));
910 smtc_seqw(0x01, (smtc_seqr(0x01) & (~0x20)));
911 smtc_seqw(0x21, (smtc_seqr(0x21) & 0x77));
912 smtc_seqw(0x22, (smtc_seqr(0x22) & (~0x30)));
913 smtc_seqw(0x31, (smtc_seqr(0x31) | 0x03));
914 smtc_seqw(0x24, (smtc_seqr(0x24) | 0x01));
915 break;
916 case FB_BLANK_NORMAL:
917 /* Screen Off: HSync: On, VSync : On Soft blank */
918 smtc_seqw(0x24, (smtc_seqr(0x24) | 0x01));
919 smtc_seqw(0x31, ((smtc_seqr(0x31) & (~0x07)) | 0x00));
920 smtc_seqw(0x23, (smtc_seqr(0x23) & (~0xc0)));
921 smtc_seqw(0x01, (smtc_seqr(0x01) & (~0x20)));
922 smtc_seqw(0x22, (smtc_seqr(0x22) & (~0x30)));
923 smtc_seqw(0x6a, 0x16);
924 smtc_seqw(0x6b, 0x02);
925 break;
926 case FB_BLANK_VSYNC_SUSPEND:
927 /* Screen On: HSync: On, VSync : Off */
928 smtc_seqw(0x24, (smtc_seqr(0x24) & (~0x01)));
929 smtc_seqw(0x31, ((smtc_seqr(0x31) & (~0x07)) | 0x00));
930 smtc_seqw(0x23, ((smtc_seqr(0x23) & (~0xc0)) | 0x20));
931 smtc_seqw(0x01, (smtc_seqr(0x01) | 0x20));
932 smtc_seqw(0x21, (smtc_seqr(0x21) | 0x88));
933 smtc_seqw(0x20, (smtc_seqr(0x20) & (~0xB0)));
934 smtc_seqw(0x22, ((smtc_seqr(0x22) & (~0x30)) | 0x20));
935 smtc_seqw(0x34, (smtc_seqr(0x34) | 0x80));
936 smtc_seqw(0x6a, 0x0c);
937 smtc_seqw(0x6b, 0x02);
938 break;
939 case FB_BLANK_HSYNC_SUSPEND:
940 /* Screen On: HSync: Off, VSync : On */
941 smtc_seqw(0x24, (smtc_seqr(0x24) & (~0x01)));
942 smtc_seqw(0x31, ((smtc_seqr(0x31) & (~0x07)) | 0x00));
943 smtc_seqw(0x23, ((smtc_seqr(0x23) & (~0xc0)) | 0xD8));
944 smtc_seqw(0x01, (smtc_seqr(0x01) | 0x20));
945 smtc_seqw(0x21, (smtc_seqr(0x21) | 0x88));
946 smtc_seqw(0x20, (smtc_seqr(0x20) & (~0xB0)));
947 smtc_seqw(0x22, ((smtc_seqr(0x22) & (~0x30)) | 0x10));
948 smtc_seqw(0x34, (smtc_seqr(0x34) | 0x80));
949 smtc_seqw(0x6a, 0x0c);
950 smtc_seqw(0x6b, 0x02);
951 break;
952 case FB_BLANK_POWERDOWN:
953 /* Screen On: HSync: Off, VSync : Off */
954 smtc_seqw(0x24, (smtc_seqr(0x24) & (~0x01)));
955 smtc_seqw(0x31, ((smtc_seqr(0x31) & (~0x07)) | 0x00));
956 smtc_seqw(0x23, ((smtc_seqr(0x23) & (~0xc0)) | 0xD8));
957 smtc_seqw(0x01, (smtc_seqr(0x01) | 0x20));
958 smtc_seqw(0x21, (smtc_seqr(0x21) | 0x88));
959 smtc_seqw(0x20, (smtc_seqr(0x20) & (~0xB0)));
960 smtc_seqw(0x22, ((smtc_seqr(0x22) & (~0x30)) | 0x30));
961 smtc_seqw(0x34, (smtc_seqr(0x34) | 0x80));
962 smtc_seqw(0x6a, 0x0c);
963 smtc_seqw(0x6b, 0x02);
964 break;
965 default:
966 return -EINVAL;
967 }
968
969 return 0;
970 }
971
smtc_setcolreg(unsigned int regno,unsigned int red,unsigned int green,unsigned int blue,unsigned int trans,struct fb_info * info)972 static int smtc_setcolreg(unsigned int regno, unsigned int red,
973 unsigned int green, unsigned int blue,
974 unsigned int trans, struct fb_info *info)
975 {
976 struct smtcfb_info *sfb;
977 u32 val;
978
979 sfb = info->par;
980
981 if (regno > 255)
982 return 1;
983
984 switch (sfb->fb->fix.visual) {
985 case FB_VISUAL_DIRECTCOLOR:
986 case FB_VISUAL_TRUECOLOR:
987 /*
988 * 16/32 bit true-colour, use pseudo-palette for 16 base color
989 */
990 if (regno >= 16)
991 break;
992 if (sfb->fb->var.bits_per_pixel == 16) {
993 u32 *pal = sfb->fb->pseudo_palette;
994
995 val = chan_to_field(red, &sfb->fb->var.red);
996 val |= chan_to_field(green, &sfb->fb->var.green);
997 val |= chan_to_field(blue, &sfb->fb->var.blue);
998 pal[regno] = pal_rgb(red, green, blue, val);
999 } else {
1000 u32 *pal = sfb->fb->pseudo_palette;
1001
1002 val = chan_to_field(red, &sfb->fb->var.red);
1003 val |= chan_to_field(green, &sfb->fb->var.green);
1004 val |= chan_to_field(blue, &sfb->fb->var.blue);
1005 pal[regno] = big_swap(val);
1006 }
1007 break;
1008
1009 case FB_VISUAL_PSEUDOCOLOR:
1010 /* color depth 8 bit */
1011 sm712_setpalette(regno, red, green, blue, info);
1012 break;
1013
1014 default:
1015 return 1; /* unknown type */
1016 }
1017
1018 return 0;
1019 }
1020
smtcfb_read(struct fb_info * info,char __user * buf,size_t count,loff_t * ppos)1021 static ssize_t smtcfb_read(struct fb_info *info, char __user *buf,
1022 size_t count, loff_t *ppos)
1023 {
1024 unsigned long p = *ppos;
1025
1026 u32 *buffer, *dst;
1027 u32 __iomem *src;
1028 int c, i, cnt = 0, err = 0;
1029 unsigned long total_size;
1030
1031 if (!info || !info->screen_base)
1032 return -ENODEV;
1033
1034 if (info->state != FBINFO_STATE_RUNNING)
1035 return -EPERM;
1036
1037 total_size = info->screen_size;
1038
1039 if (total_size == 0)
1040 total_size = info->fix.smem_len;
1041
1042 if (p >= total_size)
1043 return 0;
1044
1045 if (count >= total_size)
1046 count = total_size;
1047
1048 if (count + p > total_size)
1049 count = total_size - p;
1050
1051 buffer = kmalloc(PAGE_SIZE, GFP_KERNEL);
1052 if (!buffer)
1053 return -ENOMEM;
1054
1055 src = (u32 __iomem *)(info->screen_base + p);
1056
1057 if (info->fbops->fb_sync)
1058 info->fbops->fb_sync(info);
1059
1060 while (count) {
1061 c = (count > PAGE_SIZE) ? PAGE_SIZE : count;
1062 dst = buffer;
1063 for (i = (c + 3) >> 2; i--;) {
1064 u32 val;
1065
1066 val = fb_readl(src);
1067 *dst = big_swap(val);
1068 src++;
1069 dst++;
1070 }
1071
1072 if (copy_to_user(buf, buffer, c)) {
1073 err = -EFAULT;
1074 break;
1075 }
1076 *ppos += c;
1077 buf += c;
1078 cnt += c;
1079 count -= c;
1080 }
1081
1082 kfree(buffer);
1083
1084 return (err) ? err : cnt;
1085 }
1086
smtcfb_write(struct fb_info * info,const char __user * buf,size_t count,loff_t * ppos)1087 static ssize_t smtcfb_write(struct fb_info *info, const char __user *buf,
1088 size_t count, loff_t *ppos)
1089 {
1090 unsigned long p = *ppos;
1091
1092 u32 *buffer, *src;
1093 u32 __iomem *dst;
1094 int c, i, cnt = 0, err = 0;
1095 unsigned long total_size;
1096
1097 if (!info || !info->screen_base)
1098 return -ENODEV;
1099
1100 if (info->state != FBINFO_STATE_RUNNING)
1101 return -EPERM;
1102
1103 total_size = info->screen_size;
1104
1105 if (total_size == 0)
1106 total_size = info->fix.smem_len;
1107
1108 if (p > total_size)
1109 return -EFBIG;
1110
1111 if (count > total_size) {
1112 err = -EFBIG;
1113 count = total_size;
1114 }
1115
1116 if (count + p > total_size) {
1117 if (!err)
1118 err = -ENOSPC;
1119
1120 count = total_size - p;
1121 }
1122
1123 buffer = kmalloc(PAGE_SIZE, GFP_KERNEL);
1124 if (!buffer)
1125 return -ENOMEM;
1126
1127 dst = (u32 __iomem *)(info->screen_base + p);
1128
1129 if (info->fbops->fb_sync)
1130 info->fbops->fb_sync(info);
1131
1132 while (count) {
1133 c = (count > PAGE_SIZE) ? PAGE_SIZE : count;
1134 src = buffer;
1135
1136 if (copy_from_user(src, buf, c)) {
1137 err = -EFAULT;
1138 break;
1139 }
1140
1141 for (i = (c + 3) >> 2; i--;) {
1142 fb_writel(big_swap(*src), dst);
1143 dst++;
1144 src++;
1145 }
1146
1147 *ppos += c;
1148 buf += c;
1149 cnt += c;
1150 count -= c;
1151 }
1152
1153 kfree(buffer);
1154
1155 return (cnt) ? cnt : err;
1156 }
1157
sm7xx_set_timing(struct smtcfb_info * sfb)1158 static void sm7xx_set_timing(struct smtcfb_info *sfb)
1159 {
1160 int i = 0, j = 0;
1161 u32 m_nscreenstride;
1162
1163 dev_dbg(&sfb->pdev->dev,
1164 "sfb->width=%d sfb->height=%d sfb->fb->var.bits_per_pixel=%d sfb->hz=%d\n",
1165 sfb->width, sfb->height, sfb->fb->var.bits_per_pixel, sfb->hz);
1166
1167 for (j = 0; j < ARRAY_SIZE(vgamode); j++) {
1168 if (vgamode[j].mmsizex != sfb->width ||
1169 vgamode[j].mmsizey != sfb->height ||
1170 vgamode[j].bpp != sfb->fb->var.bits_per_pixel ||
1171 vgamode[j].hz != sfb->hz)
1172 continue;
1173
1174 dev_dbg(&sfb->pdev->dev,
1175 "vgamode[j].mmsizex=%d vgamode[j].mmSizeY=%d vgamode[j].bpp=%d vgamode[j].hz=%d\n",
1176 vgamode[j].mmsizex, vgamode[j].mmsizey,
1177 vgamode[j].bpp, vgamode[j].hz);
1178
1179 dev_dbg(&sfb->pdev->dev, "vgamode index=%d\n", j);
1180
1181 smtc_mmiowb(0x0, 0x3c6);
1182
1183 smtc_seqw(0, 0x1);
1184
1185 smtc_mmiowb(vgamode[j].init_misc, 0x3c2);
1186
1187 /* init SEQ register SR00 - SR04 */
1188 for (i = 0; i < SIZE_SR00_SR04; i++)
1189 smtc_seqw(i, vgamode[j].init_sr00_sr04[i]);
1190
1191 /* init SEQ register SR10 - SR24 */
1192 for (i = 0; i < SIZE_SR10_SR24; i++)
1193 smtc_seqw(i + 0x10, vgamode[j].init_sr10_sr24[i]);
1194
1195 /* init SEQ register SR30 - SR75 */
1196 for (i = 0; i < SIZE_SR30_SR75; i++)
1197 if ((i + 0x30) != 0x30 && (i + 0x30) != 0x62 &&
1198 (i + 0x30) != 0x6a && (i + 0x30) != 0x6b &&
1199 (i + 0x30) != 0x70 && (i + 0x30) != 0x71 &&
1200 (i + 0x30) != 0x74 && (i + 0x30) != 0x75)
1201 smtc_seqw(i + 0x30,
1202 vgamode[j].init_sr30_sr75[i]);
1203
1204 /* init SEQ register SR80 - SR93 */
1205 for (i = 0; i < SIZE_SR80_SR93; i++)
1206 smtc_seqw(i + 0x80, vgamode[j].init_sr80_sr93[i]);
1207
1208 /* init SEQ register SRA0 - SRAF */
1209 for (i = 0; i < SIZE_SRA0_SRAF; i++)
1210 smtc_seqw(i + 0xa0, vgamode[j].init_sra0_sraf[i]);
1211
1212 /* init Graphic register GR00 - GR08 */
1213 for (i = 0; i < SIZE_GR00_GR08; i++)
1214 smtc_grphw(i, vgamode[j].init_gr00_gr08[i]);
1215
1216 /* init Attribute register AR00 - AR14 */
1217 for (i = 0; i < SIZE_AR00_AR14; i++)
1218 smtc_attrw(i, vgamode[j].init_ar00_ar14[i]);
1219
1220 /* init CRTC register CR00 - CR18 */
1221 for (i = 0; i < SIZE_CR00_CR18; i++)
1222 smtc_crtcw(i, vgamode[j].init_cr00_cr18[i]);
1223
1224 /* init CRTC register CR30 - CR4D */
1225 for (i = 0; i < SIZE_CR30_CR4D; i++) {
1226 if ((i + 0x30) >= 0x3B && (i + 0x30) <= 0x3F)
1227 /* side-effect, don't write to CR3B-CR3F */
1228 continue;
1229 smtc_crtcw(i + 0x30, vgamode[j].init_cr30_cr4d[i]);
1230 }
1231
1232 /* init CRTC register CR90 - CRA7 */
1233 for (i = 0; i < SIZE_CR90_CRA7; i++)
1234 smtc_crtcw(i + 0x90, vgamode[j].init_cr90_cra7[i]);
1235 }
1236 smtc_mmiowb(0x67, 0x3c2);
1237
1238 /* set VPR registers */
1239 writel(0x0, sfb->vp_regs + 0x0C);
1240 writel(0x0, sfb->vp_regs + 0x40);
1241
1242 /* set data width */
1243 m_nscreenstride = (sfb->width * sfb->fb->var.bits_per_pixel) / 64;
1244 switch (sfb->fb->var.bits_per_pixel) {
1245 case 8:
1246 writel(0x0, sfb->vp_regs + 0x0);
1247 break;
1248 case 16:
1249 writel(0x00020000, sfb->vp_regs + 0x0);
1250 break;
1251 case 24:
1252 writel(0x00040000, sfb->vp_regs + 0x0);
1253 break;
1254 case 32:
1255 writel(0x00030000, sfb->vp_regs + 0x0);
1256 break;
1257 }
1258 writel((u32)(((m_nscreenstride + 2) << 16) | m_nscreenstride),
1259 sfb->vp_regs + 0x10);
1260 }
1261
smtc_set_timing(struct smtcfb_info * sfb)1262 static void smtc_set_timing(struct smtcfb_info *sfb)
1263 {
1264 switch (sfb->chip_id) {
1265 case 0x710:
1266 case 0x712:
1267 case 0x720:
1268 sm7xx_set_timing(sfb);
1269 break;
1270 }
1271 }
1272
smtcfb_setmode(struct smtcfb_info * sfb)1273 static void smtcfb_setmode(struct smtcfb_info *sfb)
1274 {
1275 switch (sfb->fb->var.bits_per_pixel) {
1276 case 32:
1277 sfb->fb->fix.visual = FB_VISUAL_TRUECOLOR;
1278 sfb->fb->fix.line_length = sfb->fb->var.xres * 4;
1279 sfb->fb->var.red.length = 8;
1280 sfb->fb->var.green.length = 8;
1281 sfb->fb->var.blue.length = 8;
1282 sfb->fb->var.red.offset = 16;
1283 sfb->fb->var.green.offset = 8;
1284 sfb->fb->var.blue.offset = 0;
1285 break;
1286 case 24:
1287 sfb->fb->fix.visual = FB_VISUAL_TRUECOLOR;
1288 sfb->fb->fix.line_length = sfb->fb->var.xres * 3;
1289 sfb->fb->var.red.length = 8;
1290 sfb->fb->var.green.length = 8;
1291 sfb->fb->var.blue.length = 8;
1292 sfb->fb->var.red.offset = 16;
1293 sfb->fb->var.green.offset = 8;
1294 sfb->fb->var.blue.offset = 0;
1295 break;
1296 case 8:
1297 sfb->fb->fix.visual = FB_VISUAL_PSEUDOCOLOR;
1298 sfb->fb->fix.line_length = sfb->fb->var.xres;
1299 sfb->fb->var.red.length = 3;
1300 sfb->fb->var.green.length = 3;
1301 sfb->fb->var.blue.length = 2;
1302 sfb->fb->var.red.offset = 5;
1303 sfb->fb->var.green.offset = 2;
1304 sfb->fb->var.blue.offset = 0;
1305 break;
1306 case 16:
1307 default:
1308 sfb->fb->fix.visual = FB_VISUAL_TRUECOLOR;
1309 sfb->fb->fix.line_length = sfb->fb->var.xres * 2;
1310 sfb->fb->var.red.length = 5;
1311 sfb->fb->var.green.length = 6;
1312 sfb->fb->var.blue.length = 5;
1313 sfb->fb->var.red.offset = 11;
1314 sfb->fb->var.green.offset = 5;
1315 sfb->fb->var.blue.offset = 0;
1316 break;
1317 }
1318
1319 sfb->width = sfb->fb->var.xres;
1320 sfb->height = sfb->fb->var.yres;
1321 sfb->hz = 60;
1322 smtc_set_timing(sfb);
1323 }
1324
smtc_check_var(struct fb_var_screeninfo * var,struct fb_info * info)1325 static int smtc_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
1326 {
1327 /* sanity checks */
1328 if (var->xres_virtual < var->xres)
1329 var->xres_virtual = var->xres;
1330
1331 if (var->yres_virtual < var->yres)
1332 var->yres_virtual = var->yres;
1333
1334 /* set valid default bpp */
1335 if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16) &&
1336 (var->bits_per_pixel != 24) && (var->bits_per_pixel != 32))
1337 var->bits_per_pixel = 16;
1338
1339 return 0;
1340 }
1341
smtc_set_par(struct fb_info * info)1342 static int smtc_set_par(struct fb_info *info)
1343 {
1344 smtcfb_setmode(info->par);
1345
1346 return 0;
1347 }
1348
1349 static const struct fb_ops smtcfb_ops = {
1350 .owner = THIS_MODULE,
1351 .fb_check_var = smtc_check_var,
1352 .fb_set_par = smtc_set_par,
1353 .fb_setcolreg = smtc_setcolreg,
1354 .fb_blank = smtc_blank,
1355 .fb_fillrect = cfb_fillrect,
1356 .fb_imageblit = cfb_imageblit,
1357 .fb_copyarea = cfb_copyarea,
1358 .fb_read = smtcfb_read,
1359 .fb_write = smtcfb_write,
1360 };
1361
1362 /*
1363 * Unmap in the memory mapped IO registers
1364 */
1365
smtc_unmap_mmio(struct smtcfb_info * sfb)1366 static void smtc_unmap_mmio(struct smtcfb_info *sfb)
1367 {
1368 if (sfb && smtc_regbaseaddress)
1369 smtc_regbaseaddress = NULL;
1370 }
1371
1372 /*
1373 * Map in the screen memory
1374 */
1375
smtc_map_smem(struct smtcfb_info * sfb,struct pci_dev * pdev,u_long smem_len)1376 static int smtc_map_smem(struct smtcfb_info *sfb,
1377 struct pci_dev *pdev, u_long smem_len)
1378 {
1379 sfb->fb->fix.smem_start = pci_resource_start(pdev, 0);
1380
1381 if (sfb->chip_id == 0x720)
1382 /* on SM720, the framebuffer starts at the 1 MB offset */
1383 sfb->fb->fix.smem_start += 0x00200000;
1384
1385 /* XXX: is it safe for SM720 on Big-Endian? */
1386 if (sfb->fb->var.bits_per_pixel == 32)
1387 sfb->fb->fix.smem_start += big_addr;
1388
1389 sfb->fb->fix.smem_len = smem_len;
1390
1391 sfb->fb->screen_base = sfb->lfb;
1392
1393 if (!sfb->fb->screen_base) {
1394 dev_err(&pdev->dev,
1395 "%s: unable to map screen memory\n", sfb->fb->fix.id);
1396 return -ENOMEM;
1397 }
1398
1399 return 0;
1400 }
1401
1402 /*
1403 * Unmap in the screen memory
1404 *
1405 */
smtc_unmap_smem(struct smtcfb_info * sfb)1406 static void smtc_unmap_smem(struct smtcfb_info *sfb)
1407 {
1408 if (sfb && sfb->fb->screen_base) {
1409 if (sfb->chip_id == 0x720)
1410 sfb->fb->screen_base -= 0x00200000;
1411 iounmap(sfb->fb->screen_base);
1412 sfb->fb->screen_base = NULL;
1413 }
1414 }
1415
1416 /*
1417 * We need to wake up the device and make sure its in linear memory mode.
1418 */
sm7xx_init_hw(void)1419 static inline void sm7xx_init_hw(void)
1420 {
1421 outb_p(0x18, 0x3c4);
1422 outb_p(0x11, 0x3c5);
1423 }
1424
sm7xx_vram_probe(struct smtcfb_info * sfb)1425 static u_long sm7xx_vram_probe(struct smtcfb_info *sfb)
1426 {
1427 u8 vram;
1428
1429 switch (sfb->chip_id) {
1430 case 0x710:
1431 case 0x712:
1432 /*
1433 * Assume SM712 graphics chip has 4MB VRAM.
1434 *
1435 * FIXME: SM712 can have 2MB VRAM, which is used on earlier
1436 * laptops, such as IBM Thinkpad 240X. This driver would
1437 * probably crash on those machines. If anyone gets one of
1438 * those and is willing to help, run "git blame" and send me
1439 * an E-mail.
1440 */
1441 return 0x00400000;
1442 case 0x720:
1443 outb_p(0x76, 0x3c4);
1444 vram = inb_p(0x3c5) >> 6;
1445
1446 if (vram == 0x00)
1447 return 0x00800000; /* 8 MB */
1448 else if (vram == 0x01)
1449 return 0x01000000; /* 16 MB */
1450 else if (vram == 0x02)
1451 return 0x00400000; /* illegal, fallback to 4 MB */
1452 else if (vram == 0x03)
1453 return 0x00400000; /* 4 MB */
1454 }
1455 return 0; /* unknown hardware */
1456 }
1457
sm7xx_resolution_probe(struct smtcfb_info * sfb)1458 static void sm7xx_resolution_probe(struct smtcfb_info *sfb)
1459 {
1460 /* get mode parameter from smtc_scr_info */
1461 if (smtc_scr_info.lfb_width != 0) {
1462 sfb->fb->var.xres = smtc_scr_info.lfb_width;
1463 sfb->fb->var.yres = smtc_scr_info.lfb_height;
1464 sfb->fb->var.bits_per_pixel = smtc_scr_info.lfb_depth;
1465 goto final;
1466 }
1467
1468 /*
1469 * No parameter, default resolution is 1024x768-16.
1470 *
1471 * FIXME: earlier laptops, such as IBM Thinkpad 240X, has a 800x600
1472 * panel, also see the comments about Thinkpad 240X above.
1473 */
1474 sfb->fb->var.xres = SCREEN_X_RES;
1475 sfb->fb->var.yres = SCREEN_Y_RES_PC;
1476 sfb->fb->var.bits_per_pixel = SCREEN_BPP;
1477
1478 #ifdef CONFIG_MIPS
1479 /*
1480 * Loongson MIPS netbooks use 1024x600 LCD panels, which is the original
1481 * target platform of this driver, but nearly all old x86 laptops have
1482 * 1024x768. Lighting 768 panels using 600's timings would partially
1483 * garble the display, so we don't want that. But it's not possible to
1484 * distinguish them reliably.
1485 *
1486 * So we change the default to 768, but keep 600 as-is on MIPS.
1487 */
1488 sfb->fb->var.yres = SCREEN_Y_RES_NETBOOK;
1489 #endif
1490
1491 final:
1492 big_pixel_depth(sfb->fb->var.bits_per_pixel, smtc_scr_info.lfb_depth);
1493 }
1494
smtcfb_pci_probe(struct pci_dev * pdev,const struct pci_device_id * ent)1495 static int smtcfb_pci_probe(struct pci_dev *pdev,
1496 const struct pci_device_id *ent)
1497 {
1498 struct smtcfb_info *sfb;
1499 struct fb_info *info;
1500 u_long smem_size;
1501 int err;
1502 unsigned long mmio_base;
1503
1504 dev_info(&pdev->dev, "Silicon Motion display driver.\n");
1505
1506 err = aperture_remove_conflicting_pci_devices(pdev, "smtcfb");
1507 if (err)
1508 return err;
1509
1510 err = pci_enable_device(pdev); /* enable SMTC chip */
1511 if (err)
1512 return err;
1513
1514 err = pci_request_region(pdev, 0, "sm7xxfb");
1515 if (err < 0) {
1516 dev_err(&pdev->dev, "cannot reserve framebuffer region\n");
1517 goto failed_regions;
1518 }
1519
1520 sprintf(smtcfb_fix.id, "sm%Xfb", ent->device);
1521
1522 info = framebuffer_alloc(sizeof(*sfb), &pdev->dev);
1523 if (!info) {
1524 err = -ENOMEM;
1525 goto failed_free;
1526 }
1527
1528 sfb = info->par;
1529 sfb->fb = info;
1530 sfb->chip_id = ent->device;
1531 sfb->pdev = pdev;
1532 info->flags = FBINFO_FLAG_DEFAULT;
1533 info->fbops = &smtcfb_ops;
1534 info->fix = smtcfb_fix;
1535 info->var = smtcfb_var;
1536 info->pseudo_palette = sfb->colreg;
1537 info->par = sfb;
1538
1539 pci_set_drvdata(pdev, sfb);
1540
1541 sm7xx_init_hw();
1542
1543 /* Map address and memory detection */
1544 mmio_base = pci_resource_start(pdev, 0);
1545 pci_read_config_byte(pdev, PCI_REVISION_ID, &sfb->chip_rev_id);
1546
1547 smem_size = sm7xx_vram_probe(sfb);
1548 dev_info(&pdev->dev, "%lu MiB of VRAM detected.\n",
1549 smem_size / 1048576);
1550
1551 switch (sfb->chip_id) {
1552 case 0x710:
1553 case 0x712:
1554 sfb->fb->fix.mmio_start = mmio_base + 0x00400000;
1555 sfb->fb->fix.mmio_len = 0x00400000;
1556 sfb->lfb = ioremap(mmio_base, mmio_addr);
1557 if (!sfb->lfb) {
1558 dev_err(&pdev->dev,
1559 "%s: unable to map memory mapped IO!\n",
1560 sfb->fb->fix.id);
1561 err = -ENOMEM;
1562 goto failed_fb;
1563 }
1564
1565 sfb->mmio = (smtc_regbaseaddress =
1566 sfb->lfb + 0x00700000);
1567 sfb->dp_regs = sfb->lfb + 0x00408000;
1568 sfb->vp_regs = sfb->lfb + 0x0040c000;
1569 if (sfb->fb->var.bits_per_pixel == 32) {
1570 sfb->lfb += big_addr;
1571 dev_info(&pdev->dev, "sfb->lfb=%p\n", sfb->lfb);
1572 }
1573
1574 /* set MCLK = 14.31818 * (0x16 / 0x2) */
1575 smtc_seqw(0x6a, 0x16);
1576 smtc_seqw(0x6b, 0x02);
1577 smtc_seqw(0x62, 0x3e);
1578 /* enable PCI burst */
1579 smtc_seqw(0x17, 0x20);
1580 /* enable word swap */
1581 if (sfb->fb->var.bits_per_pixel == 32)
1582 seqw17();
1583 break;
1584 case 0x720:
1585 sfb->fb->fix.mmio_start = mmio_base;
1586 sfb->fb->fix.mmio_len = 0x00200000;
1587 sfb->dp_regs = ioremap(mmio_base, 0x00200000 + smem_size);
1588 if (!sfb->dp_regs) {
1589 dev_err(&pdev->dev,
1590 "%s: unable to map memory mapped IO!\n",
1591 sfb->fb->fix.id);
1592 err = -ENOMEM;
1593 goto failed_fb;
1594 }
1595
1596 sfb->lfb = sfb->dp_regs + 0x00200000;
1597 sfb->mmio = (smtc_regbaseaddress =
1598 sfb->dp_regs + 0x000c0000);
1599 sfb->vp_regs = sfb->dp_regs + 0x800;
1600
1601 smtc_seqw(0x62, 0xff);
1602 smtc_seqw(0x6a, 0x0d);
1603 smtc_seqw(0x6b, 0x02);
1604 break;
1605 default:
1606 dev_err(&pdev->dev,
1607 "No valid Silicon Motion display chip was detected!\n");
1608 err = -ENODEV;
1609 goto failed_fb;
1610 }
1611
1612 /* probe and decide resolution */
1613 sm7xx_resolution_probe(sfb);
1614
1615 /* can support 32 bpp */
1616 if (sfb->fb->var.bits_per_pixel == 15)
1617 sfb->fb->var.bits_per_pixel = 16;
1618
1619 sfb->fb->var.xres_virtual = sfb->fb->var.xres;
1620 sfb->fb->var.yres_virtual = sfb->fb->var.yres;
1621 err = smtc_map_smem(sfb, pdev, smem_size);
1622 if (err)
1623 goto failed;
1624
1625 /*
1626 * The screen would be temporarily garbled when sm712fb takes over
1627 * vesafb or VGA text mode. Zero the framebuffer.
1628 */
1629 memset_io(sfb->lfb, 0, sfb->fb->fix.smem_len);
1630
1631 err = register_framebuffer(info);
1632 if (err < 0)
1633 goto failed;
1634
1635 dev_info(&pdev->dev,
1636 "Silicon Motion SM%X Rev%X primary display mode %dx%d-%d Init Complete.\n",
1637 sfb->chip_id, sfb->chip_rev_id, sfb->fb->var.xres,
1638 sfb->fb->var.yres, sfb->fb->var.bits_per_pixel);
1639
1640 return 0;
1641
1642 failed:
1643 dev_err(&pdev->dev, "Silicon Motion, Inc. primary display init fail.\n");
1644
1645 smtc_unmap_smem(sfb);
1646 smtc_unmap_mmio(sfb);
1647 failed_fb:
1648 framebuffer_release(info);
1649
1650 failed_free:
1651 pci_release_region(pdev, 0);
1652
1653 failed_regions:
1654 pci_disable_device(pdev);
1655
1656 return err;
1657 }
1658
1659 /*
1660 * 0x710 (LynxEM)
1661 * 0x712 (LynxEM+)
1662 * 0x720 (Lynx3DM, Lynx3DM+)
1663 */
1664 static const struct pci_device_id smtcfb_pci_table[] = {
1665 { PCI_DEVICE(0x126f, 0x710), },
1666 { PCI_DEVICE(0x126f, 0x712), },
1667 { PCI_DEVICE(0x126f, 0x720), },
1668 {0,}
1669 };
1670
1671 MODULE_DEVICE_TABLE(pci, smtcfb_pci_table);
1672
smtcfb_pci_remove(struct pci_dev * pdev)1673 static void smtcfb_pci_remove(struct pci_dev *pdev)
1674 {
1675 struct smtcfb_info *sfb;
1676
1677 sfb = pci_get_drvdata(pdev);
1678 smtc_unmap_smem(sfb);
1679 smtc_unmap_mmio(sfb);
1680 unregister_framebuffer(sfb->fb);
1681 framebuffer_release(sfb->fb);
1682 pci_release_region(pdev, 0);
1683 pci_disable_device(pdev);
1684 }
1685
smtcfb_pci_suspend(struct device * device)1686 static int __maybe_unused smtcfb_pci_suspend(struct device *device)
1687 {
1688 struct smtcfb_info *sfb = dev_get_drvdata(device);
1689
1690
1691 /* set the hw in sleep mode use external clock and self memory refresh
1692 * so that we can turn off internal PLLs later on
1693 */
1694 smtc_seqw(0x20, (smtc_seqr(0x20) | 0xc0));
1695 smtc_seqw(0x69, (smtc_seqr(0x69) & 0xf7));
1696
1697 console_lock();
1698 fb_set_suspend(sfb->fb, 1);
1699 console_unlock();
1700
1701 /* additionally turn off all function blocks including internal PLLs */
1702 smtc_seqw(0x21, 0xff);
1703
1704 return 0;
1705 }
1706
smtcfb_pci_resume(struct device * device)1707 static int __maybe_unused smtcfb_pci_resume(struct device *device)
1708 {
1709 struct smtcfb_info *sfb = dev_get_drvdata(device);
1710
1711
1712 /* reinit hardware */
1713 sm7xx_init_hw();
1714 switch (sfb->chip_id) {
1715 case 0x710:
1716 case 0x712:
1717 /* set MCLK = 14.31818 * (0x16 / 0x2) */
1718 smtc_seqw(0x6a, 0x16);
1719 smtc_seqw(0x6b, 0x02);
1720 smtc_seqw(0x62, 0x3e);
1721 /* enable PCI burst */
1722 smtc_seqw(0x17, 0x20);
1723 if (sfb->fb->var.bits_per_pixel == 32)
1724 seqw17();
1725 break;
1726 case 0x720:
1727 smtc_seqw(0x62, 0xff);
1728 smtc_seqw(0x6a, 0x0d);
1729 smtc_seqw(0x6b, 0x02);
1730 break;
1731 }
1732
1733 smtc_seqw(0x34, (smtc_seqr(0x34) | 0xc0));
1734 smtc_seqw(0x33, ((smtc_seqr(0x33) | 0x08) & 0xfb));
1735
1736 smtcfb_setmode(sfb);
1737
1738 console_lock();
1739 fb_set_suspend(sfb->fb, 0);
1740 console_unlock();
1741
1742 return 0;
1743 }
1744
1745 static SIMPLE_DEV_PM_OPS(sm7xx_pm_ops, smtcfb_pci_suspend, smtcfb_pci_resume);
1746
1747 static struct pci_driver smtcfb_driver = {
1748 .name = "smtcfb",
1749 .id_table = smtcfb_pci_table,
1750 .probe = smtcfb_pci_probe,
1751 .remove = smtcfb_pci_remove,
1752 .driver.pm = &sm7xx_pm_ops,
1753 };
1754
sm712fb_init(void)1755 static int __init sm712fb_init(void)
1756 {
1757 char *option = NULL;
1758
1759 if (fb_modesetting_disabled("sm712fb"))
1760 return -ENODEV;
1761
1762 if (fb_get_options("sm712fb", &option))
1763 return -ENODEV;
1764 if (option && *option)
1765 mode_option = option;
1766 sm7xx_vga_setup(mode_option);
1767
1768 return pci_register_driver(&smtcfb_driver);
1769 }
1770
1771 module_init(sm712fb_init);
1772
sm712fb_exit(void)1773 static void __exit sm712fb_exit(void)
1774 {
1775 pci_unregister_driver(&smtcfb_driver);
1776 }
1777
1778 module_exit(sm712fb_exit);
1779
1780 MODULE_AUTHOR("Siliconmotion ");
1781 MODULE_DESCRIPTION("Framebuffer driver for SMI Graphic Cards");
1782 MODULE_LICENSE("GPL");
1783