1
2
3
4
5
6
7
8
9#include <linux/delay.h>
10#include <linux/errno.h>
11#include <linux/fb.h>
12#include <linux/interrupt.h>
13#include <linux/pci.h>
14#include <linux/slab.h>
15#include <linux/module.h>
16
17#include "carminefb.h"
18#include "carminefb_regs.h"
19
20#if !defined(__LITTLE_ENDIAN) && !defined(__BIG_ENDIAN)
21#error "The endianness of the target host has not been defined."
22#endif
23
24
25
26
27
28
29
30
31
32
33#define CARMINEFB_DEFAULT_VIDEO_MODE 1
34
35static unsigned int fb_mode = CARMINEFB_DEFAULT_VIDEO_MODE;
36module_param(fb_mode, uint, 0444);
37MODULE_PARM_DESC(fb_mode, "Initial video mode as integer.");
38
39static char *fb_mode_str;
40module_param(fb_mode_str, charp, 0444);
41MODULE_PARM_DESC(fb_mode_str, "Initial video mode in characters.");
42
43
44
45
46
47
48
49static int fb_displays = CARMINE_USE_DISPLAY0 | CARMINE_USE_DISPLAY1;
50module_param(fb_displays, int, 0444);
51MODULE_PARM_DESC(fb_displays, "Bit mode, which displays are used");
52
53struct carmine_hw {
54 void __iomem *v_regs;
55 void __iomem *screen_mem;
56 struct fb_info *fb[MAX_DISPLAY];
57};
58
59struct carmine_resolution {
60 u32 htp;
61 u32 hsp;
62 u32 hsw;
63 u32 hdp;
64 u32 vtr;
65 u32 vsp;
66 u32 vsw;
67 u32 vdp;
68 u32 disp_mode;
69};
70
71struct carmine_fb {
72 void __iomem *display_reg;
73 void __iomem *screen_base;
74 u32 smem_offset;
75 u32 cur_mode;
76 u32 new_mode;
77 struct carmine_resolution *res;
78 u32 pseudo_palette[16];
79};
80
81static struct fb_fix_screeninfo carminefb_fix = {
82 .id = "Carmine",
83 .type = FB_TYPE_PACKED_PIXELS,
84 .visual = FB_VISUAL_TRUECOLOR,
85 .accel = FB_ACCEL_NONE,
86};
87
88static const struct fb_videomode carmine_modedb[] = {
89 {
90 .name = "640x480",
91 .xres = 640,
92 .yres = 480,
93 }, {
94 .name = "800x600",
95 .xres = 800,
96 .yres = 600,
97 },
98};
99
100static struct carmine_resolution car_modes[] = {
101 {
102
103 .htp = 800,
104 .hsp = 672,
105 .hsw = 96,
106 .hdp = 640,
107 .vtr = 525,
108 .vsp = 490,
109 .vsw = 2,
110 .vdp = 480,
111 .disp_mode = 0x1400,
112 },
113 {
114
115 .htp = 1060,
116 .hsp = 864,
117 .hsw = 72,
118 .hdp = 800,
119 .vtr = 628,
120 .vsp = 601,
121 .vsw = 2,
122 .vdp = 600,
123 .disp_mode = 0x0d00,
124 }
125};
126
127static int carmine_find_mode(const struct fb_var_screeninfo *var)
128{
129 int i;
130
131 for (i = 0; i < ARRAY_SIZE(car_modes); i++)
132 if (car_modes[i].hdp == var->xres &&
133 car_modes[i].vdp == var->yres)
134 return i;
135 return -EINVAL;
136}
137
138static void c_set_disp_reg(const struct carmine_fb *par,
139 u32 offset, u32 val)
140{
141 writel(val, par->display_reg + offset);
142}
143
144static u32 c_get_disp_reg(const struct carmine_fb *par,
145 u32 offset)
146{
147 return readl(par->display_reg + offset);
148}
149
150static void c_set_hw_reg(const struct carmine_hw *hw,
151 u32 offset, u32 val)
152{
153 writel(val, hw->v_regs + offset);
154}
155
156static u32 c_get_hw_reg(const struct carmine_hw *hw,
157 u32 offset)
158{
159 return readl(hw->v_regs + offset);
160}
161
162static int carmine_setcolreg(unsigned regno, unsigned red, unsigned green,
163 unsigned blue, unsigned transp, struct fb_info *info)
164{
165 if (regno >= 16)
166 return 1;
167
168 red >>= 8;
169 green >>= 8;
170 blue >>= 8;
171 transp >>= 8;
172
173 ((__be32 *)info->pseudo_palette)[regno] = cpu_to_be32(transp << 24 |
174 red << 0 | green << 8 | blue << 16);
175 return 0;
176}
177
178static int carmine_check_var(struct fb_var_screeninfo *var,
179 struct fb_info *info)
180{
181 int ret;
182
183 ret = carmine_find_mode(var);
184 if (ret < 0)
185 return ret;
186
187 if (var->grayscale || var->rotate || var->nonstd)
188 return -EINVAL;
189
190 var->xres_virtual = var->xres;
191 var->yres_virtual = var->yres;
192
193 var->bits_per_pixel = 32;
194
195#ifdef __BIG_ENDIAN
196 var->transp.offset = 24;
197 var->red.offset = 0;
198 var->green.offset = 8;
199 var->blue.offset = 16;
200#else
201 var->transp.offset = 24;
202 var->red.offset = 16;
203 var->green.offset = 8;
204 var->blue.offset = 0;
205#endif
206
207 var->red.length = 8;
208 var->green.length = 8;
209 var->blue.length = 8;
210 var->transp.length = 8;
211
212 var->red.msb_right = 0;
213 var->green.msb_right = 0;
214 var->blue.msb_right = 0;
215 var->transp.msb_right = 0;
216 return 0;
217}
218
219static void carmine_init_display_param(struct carmine_fb *par)
220{
221 u32 width;
222 u32 height;
223 u32 param;
224 u32 window_size;
225 u32 soffset = par->smem_offset;
226
227 c_set_disp_reg(par, CARMINE_DISP_REG_C_TRANS, 0);
228 c_set_disp_reg(par, CARMINE_DISP_REG_MLMR_TRANS, 0);
229 c_set_disp_reg(par, CARMINE_DISP_REG_CURSOR_MODE,
230 CARMINE_CURSOR0_PRIORITY_MASK |
231 CARMINE_CURSOR1_PRIORITY_MASK |
232 CARMINE_CURSOR_CUTZ_MASK);
233
234
235 c_set_disp_reg(par, CARMINE_DISP_REG_CUR1_POS, 0 << 16 | 0);
236 c_set_disp_reg(par, CARMINE_DISP_REG_CUR2_POS, 0 << 16 | 0);
237
238
239 c_set_disp_reg(par, CARMINE_DISP_REG_L0_EXT_MODE, CARMINE_WINDOW_MODE |
240 CARMINE_EXT_CMODE_DIRECT24_RGBA);
241 c_set_disp_reg(par, CARMINE_DISP_REG_L1_EXT_MODE,
242 CARMINE_EXT_CMODE_DIRECT24_RGBA);
243 c_set_disp_reg(par, CARMINE_DISP_REG_L2_EXT_MODE, CARMINE_EXTEND_MODE |
244 CARMINE_EXT_CMODE_DIRECT24_RGBA);
245 c_set_disp_reg(par, CARMINE_DISP_REG_L3_EXT_MODE, CARMINE_EXTEND_MODE |
246 CARMINE_EXT_CMODE_DIRECT24_RGBA);
247 c_set_disp_reg(par, CARMINE_DISP_REG_L4_EXT_MODE, CARMINE_EXTEND_MODE |
248 CARMINE_EXT_CMODE_DIRECT24_RGBA);
249 c_set_disp_reg(par, CARMINE_DISP_REG_L5_EXT_MODE, CARMINE_EXTEND_MODE |
250 CARMINE_EXT_CMODE_DIRECT24_RGBA);
251 c_set_disp_reg(par, CARMINE_DISP_REG_L6_EXT_MODE, CARMINE_EXTEND_MODE |
252 CARMINE_EXT_CMODE_DIRECT24_RGBA);
253 c_set_disp_reg(par, CARMINE_DISP_REG_L7_EXT_MODE, CARMINE_EXTEND_MODE |
254 CARMINE_EXT_CMODE_DIRECT24_RGBA);
255
256
257 width = par->res->hdp * 4 / CARMINE_DISP_WIDTH_UNIT;
258 width = width << CARMINE_DISP_WIDTH_SHIFT;
259
260 height = par->res->vdp - 1;
261 param = width | height;
262
263 c_set_disp_reg(par, CARMINE_DISP_REG_L0_MODE_W_H, param);
264 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIDTH, width);
265 c_set_disp_reg(par, CARMINE_DISP_REG_L2_MODE_W_H, param);
266 c_set_disp_reg(par, CARMINE_DISP_REG_L3_MODE_W_H, param);
267 c_set_disp_reg(par, CARMINE_DISP_REG_L4_MODE_W_H, param);
268 c_set_disp_reg(par, CARMINE_DISP_REG_L5_MODE_W_H, param);
269 c_set_disp_reg(par, CARMINE_DISP_REG_L6_MODE_W_H, param);
270 c_set_disp_reg(par, CARMINE_DISP_REG_L7_MODE_W_H, param);
271
272
273 window_size = (par->res->vdp - 1) << CARMINE_DISP_WIN_H_SHIFT;
274 window_size |= par->res->hdp;
275
276 c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_POS, 0);
277 c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_SIZE, window_size);
278 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_POS, 0);
279 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_SIZE, window_size);
280 c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_POS, 0);
281 c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_SIZE, window_size);
282 c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_POS, 0);
283 c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_SIZE, window_size);
284 c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_POS, 0);
285 c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_SIZE, window_size);
286 c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_POS, 0);
287 c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_SIZE, window_size);
288 c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_POS, 0);
289 c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_SIZE, window_size);
290 c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_POS, 0);
291 c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_SIZE, window_size);
292
293
294 c_set_disp_reg(par, CARMINE_DISP_REG_L0_ORG_ADR, soffset);
295 c_set_disp_reg(par, CARMINE_DISP_REG_L1_ORG_ADR, soffset);
296 c_set_disp_reg(par, CARMINE_DISP_REG_L2_ORG_ADR1, soffset);
297 c_set_disp_reg(par, CARMINE_DISP_REG_L3_ORG_ADR1, soffset);
298 c_set_disp_reg(par, CARMINE_DISP_REG_L4_ORG_ADR1, soffset);
299 c_set_disp_reg(par, CARMINE_DISP_REG_L5_ORG_ADR1, soffset);
300 c_set_disp_reg(par, CARMINE_DISP_REG_L6_ORG_ADR1, soffset);
301 c_set_disp_reg(par, CARMINE_DISP_REG_L7_ORG_ADR1, soffset);
302
303
304 c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_ADR, soffset);
305 c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_ADR1, soffset);
306 c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_ADR1, soffset);
307 c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_ADR1, soffset);
308 c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_ADR1, soffset);
309 c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_ADR0, soffset);
310 c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_ADR0, soffset);
311
312
313 c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_POS, 0);
314 c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_POS, 0);
315 c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_POS, 0);
316 c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_POS, 0);
317 c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_POS, 0);
318 c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_POS, 0);
319 c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_POS, 0);
320
321
322 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L0, 0);
323 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L1, 0);
324 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L2, 0);
325 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L3, 0);
326 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L4, 0);
327 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L5, 0);
328 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L6, 0);
329 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L7, 0);
330
331
332 c_set_disp_reg(par, CARMINE_DISP_REG_L0_TRANS, 0);
333 c_set_disp_reg(par, CARMINE_DISP_REG_L1_TRANS, 0);
334 c_set_disp_reg(par, CARMINE_DISP_REG_L2_TRANS, 0);
335 c_set_disp_reg(par, CARMINE_DISP_REG_L3_TRANS, 0);
336 c_set_disp_reg(par, CARMINE_DISP_REG_L4_TRANS, 0);
337 c_set_disp_reg(par, CARMINE_DISP_REG_L5_TRANS, 0);
338 c_set_disp_reg(par, CARMINE_DISP_REG_L6_TRANS, 0);
339 c_set_disp_reg(par, CARMINE_DISP_REG_L7_TRANS, 0);
340
341
342 c_set_disp_reg(par, CARMINE_DISP_REG_L0RM, 0);
343 c_set_disp_reg(par, CARMINE_DISP_REG_L2RM, 0);
344 c_set_disp_reg(par, CARMINE_DISP_REG_L3RM, 0);
345 c_set_disp_reg(par, CARMINE_DISP_REG_L4RM, 0);
346 c_set_disp_reg(par, CARMINE_DISP_REG_L5RM, 0);
347 c_set_disp_reg(par, CARMINE_DISP_REG_L6RM, 0);
348 c_set_disp_reg(par, CARMINE_DISP_REG_L7RM, 0);
349
350 c_set_disp_reg(par, CARMINE_DISP_REG_L0PX, 0);
351 c_set_disp_reg(par, CARMINE_DISP_REG_L2PX, 0);
352 c_set_disp_reg(par, CARMINE_DISP_REG_L3PX, 0);
353 c_set_disp_reg(par, CARMINE_DISP_REG_L4PX, 0);
354 c_set_disp_reg(par, CARMINE_DISP_REG_L5PX, 0);
355 c_set_disp_reg(par, CARMINE_DISP_REG_L6PX, 0);
356 c_set_disp_reg(par, CARMINE_DISP_REG_L7PX, 0);
357
358 c_set_disp_reg(par, CARMINE_DISP_REG_L0PY, 0);
359 c_set_disp_reg(par, CARMINE_DISP_REG_L2PY, 0);
360 c_set_disp_reg(par, CARMINE_DISP_REG_L3PY, 0);
361 c_set_disp_reg(par, CARMINE_DISP_REG_L4PY, 0);
362 c_set_disp_reg(par, CARMINE_DISP_REG_L5PY, 0);
363 c_set_disp_reg(par, CARMINE_DISP_REG_L6PY, 0);
364 c_set_disp_reg(par, CARMINE_DISP_REG_L7PY, 0);
365}
366
367static void set_display_parameters(struct carmine_fb *par)
368{
369 u32 mode;
370 u32 hdp, vdp, htp, hsp, hsw, vtr, vsp, vsw;
371
372
373
374
375
376 hdp = par->res->hdp - 1;
377 vdp = par->res->vdp - 1;
378 htp = par->res->htp - 1;
379 hsp = par->res->hsp - 1;
380 hsw = par->res->hsw - 1;
381 vtr = par->res->vtr - 1;
382 vsp = par->res->vsp - 1;
383 vsw = par->res->vsw - 1;
384
385 c_set_disp_reg(par, CARMINE_DISP_REG_H_TOTAL,
386 htp << CARMINE_DISP_HTP_SHIFT);
387 c_set_disp_reg(par, CARMINE_DISP_REG_H_PERIOD,
388 (hdp << CARMINE_DISP_HDB_SHIFT) | hdp);
389 c_set_disp_reg(par, CARMINE_DISP_REG_V_H_W_H_POS,
390 (vsw << CARMINE_DISP_VSW_SHIFT) |
391 (hsw << CARMINE_DISP_HSW_SHIFT) |
392 (hsp));
393 c_set_disp_reg(par, CARMINE_DISP_REG_V_TOTAL,
394 vtr << CARMINE_DISP_VTR_SHIFT);
395 c_set_disp_reg(par, CARMINE_DISP_REG_V_PERIOD_POS,
396 (vdp << CARMINE_DISP_VDP_SHIFT) | vsp);
397
398
399 mode = c_get_disp_reg(par, CARMINE_DISP_REG_DCM1);
400 mode = (mode & ~CARMINE_DISP_DCM_MASK) |
401 (par->res->disp_mode & CARMINE_DISP_DCM_MASK);
402
403 mode |= CARMINE_DEN | CARMINE_L0E;
404 c_set_disp_reg(par, CARMINE_DISP_REG_DCM1, mode);
405}
406
407static int carmine_set_par(struct fb_info *info)
408{
409 struct carmine_fb *par = info->par;
410 int ret;
411
412 ret = carmine_find_mode(&info->var);
413 if (ret < 0)
414 return ret;
415
416 par->new_mode = ret;
417 if (par->cur_mode != par->new_mode) {
418
419 par->cur_mode = par->new_mode;
420 par->res = &car_modes[par->new_mode];
421
422 carmine_init_display_param(par);
423 set_display_parameters(par);
424 }
425
426 info->fix.line_length = info->var.xres * info->var.bits_per_pixel / 8;
427 return 0;
428}
429
430static int init_hardware(struct carmine_hw *hw)
431{
432 u32 flags;
433 u32 loops;
434 u32 ret;
435
436
437
438 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE,
439 CARMINE_DFLT_IP_CLOCK_ENABLE);
440
441
442 c_set_hw_reg(hw, CARMINE_DISP0_REG + CARMINE_DISP_REG_DCM1, 0);
443 c_set_hw_reg(hw, CARMINE_DISP1_REG + CARMINE_DISP_REG_DCM1, 0);
444
445
446 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_SOFTWARE_RESET, 1);
447 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_SOFTWARE_RESET, 0);
448
449
450 flags = CARMINE_DFLT_IP_DCTL_IO_CONT1 << 16 |
451 CARMINE_DFLT_IP_DCTL_IO_CONT0;
452 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_IOCONT1_IOCONT0,
453 flags);
454
455
456 flags = CARMINE_DFLT_IP_DCTL_MODE << 16 | CARMINE_DFLT_IP_DCTL_ADD;
457 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_MODE_ADD,
458 flags);
459
460 flags = CARMINE_DFLT_IP_DCTL_SET_TIME1 << 16 |
461 CARMINE_DFLT_IP_DCTL_EMODE;
462 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_SETTIME1_EMODE,
463 flags);
464
465 flags = CARMINE_DFLT_IP_DCTL_REFRESH << 16 |
466 CARMINE_DFLT_IP_DCTL_SET_TIME2;
467 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_REFRESH_SETTIME2,
468 flags);
469
470 flags = CARMINE_DFLT_IP_DCTL_RESERVE2 << 16 |
471 CARMINE_DFLT_IP_DCTL_FIFO_DEPTH;
472 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV2_RSV1, flags);
473
474 flags = CARMINE_DFLT_IP_DCTL_DDRIF2 << 16 | CARMINE_DFLT_IP_DCTL_DDRIF1;
475 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_DDRIF2_DDRIF1,
476 flags);
477
478 flags = CARMINE_DFLT_IP_DCTL_RESERVE0 << 16 |
479 CARMINE_DFLT_IP_DCTL_STATES;
480 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV0_STATES,
481 flags);
482
483
484 if (CARMINE_DCTL_DLL_RESET) {
485 for (loops = 0; loops < CARMINE_DCTL_INIT_WAIT_LIMIT; loops++) {
486
487 ret = c_get_hw_reg(hw, CARMINE_DCTL_REG +
488 CARMINE_DCTL_REG_RSV0_STATES);
489 ret &= CARMINE_DCTL_REG_STATES_MASK;
490 if (!ret)
491 break;
492
493 mdelay(CARMINE_DCTL_INIT_WAIT_INTERVAL);
494 }
495
496 if (loops >= CARMINE_DCTL_INIT_WAIT_LIMIT) {
497 printk(KERN_ERR "DRAM init failed\n");
498 return -EIO;
499 }
500 }
501
502 flags = CARMINE_DFLT_IP_DCTL_MODE_AFT_RST << 16 |
503 CARMINE_DFLT_IP_DCTL_ADD;
504 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_MODE_ADD, flags);
505
506 flags = CARMINE_DFLT_IP_DCTL_RESERVE0 << 16 |
507 CARMINE_DFLT_IP_DCTL_STATES_AFT_RST;
508 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV0_STATES,
509 flags);
510
511
512 c_set_hw_reg(hw, CARMINE_WB_REG + CARMINE_WB_REG_WBM,
513 CARMINE_WB_REG_WBM_DEFAULT);
514
515
516 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_VRINTM, 0);
517 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_VRERRM, 0);
518
519
520 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_PX, 0);
521 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_PY, 0);
522 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_LX, 0);
523 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_LY, 0);
524 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_TX, 0);
525 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_TY, 0);
526 return 0;
527}
528
529static struct fb_ops carminefb_ops = {
530 .owner = THIS_MODULE,
531 .fb_fillrect = cfb_fillrect,
532 .fb_copyarea = cfb_copyarea,
533 .fb_imageblit = cfb_imageblit,
534
535 .fb_check_var = carmine_check_var,
536 .fb_set_par = carmine_set_par,
537 .fb_setcolreg = carmine_setcolreg,
538};
539
540static int alloc_carmine_fb(void __iomem *regs, void __iomem *smem_base,
541 int smem_offset, struct device *device,
542 struct fb_info **rinfo)
543{
544 int ret;
545 struct fb_info *info;
546 struct carmine_fb *par;
547
548 info = framebuffer_alloc(sizeof *par, device);
549 if (!info)
550 return -ENOMEM;
551
552 par = info->par;
553 par->display_reg = regs;
554 par->smem_offset = smem_offset;
555
556 info->screen_base = smem_base + smem_offset;
557 info->screen_size = CARMINE_DISPLAY_MEM;
558 info->fbops = &carminefb_ops;
559
560 info->fix = carminefb_fix;
561 info->pseudo_palette = par->pseudo_palette;
562 info->flags = FBINFO_DEFAULT;
563
564 ret = fb_alloc_cmap(&info->cmap, 256, 1);
565 if (ret < 0)
566 goto err_free_fb;
567
568 if (fb_mode >= ARRAY_SIZE(carmine_modedb))
569 fb_mode = CARMINEFB_DEFAULT_VIDEO_MODE;
570
571 par->cur_mode = par->new_mode = ~0;
572
573 ret = fb_find_mode(&info->var, info, fb_mode_str, carmine_modedb,
574 ARRAY_SIZE(carmine_modedb),
575 &carmine_modedb[fb_mode], 32);
576 if (!ret || ret == 4) {
577 ret = -EINVAL;
578 goto err_dealloc_cmap;
579 }
580
581 fb_videomode_to_modelist(carmine_modedb, ARRAY_SIZE(carmine_modedb),
582 &info->modelist);
583
584 ret = register_framebuffer(info);
585 if (ret < 0)
586 goto err_dealloc_cmap;
587
588 fb_info(info, "%s frame buffer device\n", info->fix.id);
589
590 *rinfo = info;
591 return 0;
592
593err_dealloc_cmap:
594 fb_dealloc_cmap(&info->cmap);
595err_free_fb:
596 framebuffer_release(info);
597 return ret;
598}
599
600static void cleanup_fb_device(struct fb_info *info)
601{
602 if (info) {
603 unregister_framebuffer(info);
604 fb_dealloc_cmap(&info->cmap);
605 framebuffer_release(info);
606 }
607}
608
609static int carminefb_probe(struct pci_dev *dev, const struct pci_device_id *ent)
610{
611 struct carmine_hw *hw;
612 struct device *device = &dev->dev;
613 struct fb_info *info;
614 int ret;
615
616 ret = pci_enable_device(dev);
617 if (ret)
618 return ret;
619
620 ret = -ENOMEM;
621 hw = kzalloc(sizeof *hw, GFP_KERNEL);
622 if (!hw)
623 goto err_enable_pci;
624
625 carminefb_fix.mmio_start = pci_resource_start(dev, CARMINE_CONFIG_BAR);
626 carminefb_fix.mmio_len = pci_resource_len(dev, CARMINE_CONFIG_BAR);
627
628 if (!request_mem_region(carminefb_fix.mmio_start,
629 carminefb_fix.mmio_len,
630 "carminefb regbase")) {
631 printk(KERN_ERR "carminefb: Can't reserve regbase.\n");
632 ret = -EBUSY;
633 goto err_free_hw;
634 }
635 hw->v_regs = ioremap_nocache(carminefb_fix.mmio_start,
636 carminefb_fix.mmio_len);
637 if (!hw->v_regs) {
638 printk(KERN_ERR "carminefb: Can't remap %s register.\n",
639 carminefb_fix.id);
640 goto err_free_reg_mmio;
641 }
642
643 carminefb_fix.smem_start = pci_resource_start(dev, CARMINE_MEMORY_BAR);
644 carminefb_fix.smem_len = pci_resource_len(dev, CARMINE_MEMORY_BAR);
645
646
647
648
649
650 if (carminefb_fix.smem_len > CARMINE_TOTAL_DIPLAY_MEM)
651 carminefb_fix.smem_len = CARMINE_TOTAL_DIPLAY_MEM;
652
653 else if (carminefb_fix.smem_len < CARMINE_TOTAL_DIPLAY_MEM) {
654 printk(KERN_ERR "carminefb: Memory bar is only %d bytes, %d "
655 "are required.", carminefb_fix.smem_len,
656 CARMINE_TOTAL_DIPLAY_MEM);
657 goto err_unmap_vregs;
658 }
659
660 if (!request_mem_region(carminefb_fix.smem_start,
661 carminefb_fix.smem_len, "carminefb smem")) {
662 printk(KERN_ERR "carminefb: Can't reserve smem.\n");
663 goto err_unmap_vregs;
664 }
665
666 hw->screen_mem = ioremap_nocache(carminefb_fix.smem_start,
667 carminefb_fix.smem_len);
668 if (!hw->screen_mem) {
669 printk(KERN_ERR "carmine: Can't ioremap smem area.\n");
670 goto err_reg_smem;
671 }
672
673 ret = init_hardware(hw);
674 if (ret)
675 goto err_unmap_screen;
676
677 info = NULL;
678 if (fb_displays & CARMINE_USE_DISPLAY0) {
679 ret = alloc_carmine_fb(hw->v_regs + CARMINE_DISP0_REG,
680 hw->screen_mem, CARMINE_DISPLAY_MEM * 0,
681 device, &info);
682 if (ret)
683 goto err_deinit_hw;
684 }
685
686 hw->fb[0] = info;
687
688 info = NULL;
689 if (fb_displays & CARMINE_USE_DISPLAY1) {
690 ret = alloc_carmine_fb(hw->v_regs + CARMINE_DISP1_REG,
691 hw->screen_mem, CARMINE_DISPLAY_MEM * 1,
692 device, &info);
693 if (ret)
694 goto err_cleanup_fb0;
695 }
696
697 hw->fb[1] = info;
698 info = NULL;
699
700 pci_set_drvdata(dev, hw);
701 return 0;
702
703err_cleanup_fb0:
704 cleanup_fb_device(hw->fb[0]);
705err_deinit_hw:
706
707 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE, 0);
708err_unmap_screen:
709 iounmap(hw->screen_mem);
710err_reg_smem:
711 release_mem_region(carminefb_fix.smem_start, carminefb_fix.smem_len);
712err_unmap_vregs:
713 iounmap(hw->v_regs);
714err_free_reg_mmio:
715 release_mem_region(carminefb_fix.mmio_start, carminefb_fix.mmio_len);
716err_free_hw:
717 kfree(hw);
718err_enable_pci:
719 pci_disable_device(dev);
720 return ret;
721}
722
723static void carminefb_remove(struct pci_dev *dev)
724{
725 struct carmine_hw *hw = pci_get_drvdata(dev);
726 struct fb_fix_screeninfo fix;
727 int i;
728
729
730 if (hw->fb[0])
731 fix = hw->fb[0]->fix;
732 else
733 fix = hw->fb[1]->fix;
734
735
736 c_set_hw_reg(hw, CARMINE_DISP0_REG + CARMINE_DISP_REG_DCM1, 0);
737 c_set_hw_reg(hw, CARMINE_DISP1_REG + CARMINE_DISP_REG_DCM1, 0);
738 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE, 0);
739
740 for (i = 0; i < MAX_DISPLAY; i++)
741 cleanup_fb_device(hw->fb[i]);
742
743 iounmap(hw->screen_mem);
744 release_mem_region(fix.smem_start, fix.smem_len);
745 iounmap(hw->v_regs);
746 release_mem_region(fix.mmio_start, fix.mmio_len);
747
748 pci_disable_device(dev);
749 kfree(hw);
750}
751
752#define PCI_VENDOR_ID_FUJITU_LIMITED 0x10cf
753static struct pci_device_id carmine_devices[] = {
754{
755 PCI_DEVICE(PCI_VENDOR_ID_FUJITU_LIMITED, 0x202b)},
756 {0, 0, 0, 0, 0, 0, 0}
757};
758
759MODULE_DEVICE_TABLE(pci, carmine_devices);
760
761static struct pci_driver carmine_pci_driver = {
762 .name = "carminefb",
763 .id_table = carmine_devices,
764 .probe = carminefb_probe,
765 .remove = carminefb_remove,
766};
767
768static int __init carminefb_init(void)
769{
770 if (!(fb_displays &
771 (CARMINE_USE_DISPLAY0 | CARMINE_USE_DISPLAY1))) {
772 printk(KERN_ERR "If you disable both displays than you don't "
773 "need the driver at all\n");
774 return -EINVAL;
775 }
776 return pci_register_driver(&carmine_pci_driver);
777}
778module_init(carminefb_init);
779
780static void __exit carminefb_cleanup(void)
781{
782 pci_unregister_driver(&carmine_pci_driver);
783}
784module_exit(carminefb_cleanup);
785
786MODULE_AUTHOR("Sebastian Siewior <bigeasy@linutronix.de>");
787MODULE_DESCRIPTION("Framebuffer driver for Fujitsu Carmine based devices");
788MODULE_LICENSE("GPL v2");
789
