Commit | Line | Data |
---|---|---|
cffd9348 MH |
1 | /* |
2 | * Frame buffer driver for ADV7393/2 video encoder | |
3 | * | |
4 | * Copyright 2006-2009 Analog Devices Inc. | |
5 | * Licensed under the GPL-2 or late. | |
6 | */ | |
7 | ||
8 | /* | |
9 | * TODO: Remove Globals | |
10 | * TODO: Code Cleanup | |
11 | */ | |
12 | ||
13 | #define pr_fmt(fmt) DRIVER_NAME ": " fmt | |
14 | ||
15 | #include <linux/module.h> | |
16 | #include <linux/kernel.h> | |
17 | #include <linux/errno.h> | |
18 | #include <linux/string.h> | |
19 | #include <linux/mm.h> | |
20 | #include <linux/tty.h> | |
21 | #include <linux/slab.h> | |
22 | #include <linux/delay.h> | |
23 | #include <linux/fb.h> | |
24 | #include <linux/ioport.h> | |
25 | #include <linux/init.h> | |
26 | #include <linux/types.h> | |
27 | #include <linux/interrupt.h> | |
28 | #include <linux/sched.h> | |
29 | #include <asm/blackfin.h> | |
30 | #include <asm/irq.h> | |
31 | #include <asm/dma.h> | |
32 | #include <linux/uaccess.h> | |
33 | #include <linux/gpio.h> | |
34 | #include <asm/portmux.h> | |
35 | ||
36 | #include <linux/dma-mapping.h> | |
37 | #include <linux/proc_fs.h> | |
38 | #include <linux/platform_device.h> | |
cffd9348 | 39 | #include <linux/i2c.h> |
cffd9348 MH |
40 | |
41 | #include "bfin_adv7393fb.h" | |
42 | ||
43 | static int mode = VMODE; | |
44 | static int mem = VMEM; | |
45 | static int nocursor = 1; | |
46 | ||
47 | static const unsigned short ppi_pins[] = { | |
48 | P_PPI0_CLK, P_PPI0_FS1, P_PPI0_FS2, | |
49 | P_PPI0_D0, P_PPI0_D1, P_PPI0_D2, P_PPI0_D3, | |
50 | P_PPI0_D4, P_PPI0_D5, P_PPI0_D6, P_PPI0_D7, | |
51 | P_PPI0_D8, P_PPI0_D9, P_PPI0_D10, P_PPI0_D11, | |
52 | P_PPI0_D12, P_PPI0_D13, P_PPI0_D14, P_PPI0_D15, | |
53 | 0 | |
54 | }; | |
55 | ||
56 | /* | |
57 | * card parameters | |
58 | */ | |
59 | ||
60 | static struct bfin_adv7393_fb_par { | |
61 | /* structure holding blackfin / adv7393 paramters when | |
62 | screen is blanked */ | |
63 | struct { | |
64 | u8 Mode; /* ntsc/pal/? */ | |
65 | } vga_state; | |
66 | atomic_t ref_count; | |
67 | } bfin_par; | |
68 | ||
69 | /* --------------------------------------------------------------------- */ | |
70 | ||
71 | static struct fb_var_screeninfo bfin_adv7393_fb_defined = { | |
72 | .xres = 720, | |
73 | .yres = 480, | |
74 | .xres_virtual = 720, | |
75 | .yres_virtual = 480, | |
76 | .bits_per_pixel = 16, | |
77 | .activate = FB_ACTIVATE_TEST, | |
78 | .height = -1, | |
79 | .width = -1, | |
80 | .left_margin = 0, | |
81 | .right_margin = 0, | |
82 | .upper_margin = 0, | |
83 | .lower_margin = 0, | |
84 | .vmode = FB_VMODE_INTERLACED, | |
85 | .red = {11, 5, 0}, | |
86 | .green = {5, 6, 0}, | |
87 | .blue = {0, 5, 0}, | |
88 | .transp = {0, 0, 0}, | |
89 | }; | |
90 | ||
91 | static struct fb_fix_screeninfo bfin_adv7393_fb_fix __devinitdata = { | |
92 | .id = "BFIN ADV7393", | |
93 | .smem_len = 720 * 480 * 2, | |
94 | .type = FB_TYPE_PACKED_PIXELS, | |
95 | .visual = FB_VISUAL_TRUECOLOR, | |
96 | .xpanstep = 0, | |
97 | .ypanstep = 0, | |
98 | .line_length = 720 * 2, | |
99 | .accel = FB_ACCEL_NONE | |
100 | }; | |
101 | ||
102 | static struct fb_ops bfin_adv7393_fb_ops = { | |
103 | .owner = THIS_MODULE, | |
104 | .fb_open = bfin_adv7393_fb_open, | |
105 | .fb_release = bfin_adv7393_fb_release, | |
106 | .fb_check_var = bfin_adv7393_fb_check_var, | |
107 | .fb_pan_display = bfin_adv7393_fb_pan_display, | |
108 | .fb_blank = bfin_adv7393_fb_blank, | |
109 | .fb_fillrect = cfb_fillrect, | |
110 | .fb_copyarea = cfb_copyarea, | |
111 | .fb_imageblit = cfb_imageblit, | |
112 | .fb_cursor = bfin_adv7393_fb_cursor, | |
113 | .fb_setcolreg = bfin_adv7393_fb_setcolreg, | |
114 | }; | |
115 | ||
116 | static int dma_desc_list(struct adv7393fb_device *fbdev, u16 arg) | |
117 | { | |
118 | if (arg == BUILD) { /* Build */ | |
119 | fbdev->vb1 = l1_data_sram_zalloc(sizeof(struct dmasg)); | |
120 | if (fbdev->vb1 == NULL) | |
121 | goto error; | |
122 | ||
123 | fbdev->av1 = l1_data_sram_zalloc(sizeof(struct dmasg)); | |
124 | if (fbdev->av1 == NULL) | |
125 | goto error; | |
126 | ||
127 | fbdev->vb2 = l1_data_sram_zalloc(sizeof(struct dmasg)); | |
128 | if (fbdev->vb2 == NULL) | |
129 | goto error; | |
130 | ||
131 | fbdev->av2 = l1_data_sram_zalloc(sizeof(struct dmasg)); | |
132 | if (fbdev->av2 == NULL) | |
133 | goto error; | |
134 | ||
135 | /* Build linked DMA descriptor list */ | |
136 | fbdev->vb1->next_desc_addr = fbdev->av1; | |
137 | fbdev->av1->next_desc_addr = fbdev->vb2; | |
138 | fbdev->vb2->next_desc_addr = fbdev->av2; | |
139 | fbdev->av2->next_desc_addr = fbdev->vb1; | |
140 | ||
141 | /* Save list head */ | |
142 | fbdev->descriptor_list_head = fbdev->av2; | |
143 | ||
144 | /* Vertical Blanking Field 1 */ | |
145 | fbdev->vb1->start_addr = VB_DUMMY_MEMORY_SOURCE; | |
146 | fbdev->vb1->cfg = DMA_CFG_VAL; | |
147 | ||
148 | fbdev->vb1->x_count = | |
149 | fbdev->modes[mode].xres + fbdev->modes[mode].boeft_blank; | |
150 | ||
151 | fbdev->vb1->x_modify = 0; | |
152 | fbdev->vb1->y_count = fbdev->modes[mode].vb1_lines; | |
153 | fbdev->vb1->y_modify = 0; | |
154 | ||
155 | /* Active Video Field 1 */ | |
156 | ||
157 | fbdev->av1->start_addr = (unsigned long)fbdev->fb_mem; | |
158 | fbdev->av1->cfg = DMA_CFG_VAL; | |
159 | fbdev->av1->x_count = | |
160 | fbdev->modes[mode].xres + fbdev->modes[mode].boeft_blank; | |
161 | fbdev->av1->x_modify = fbdev->modes[mode].bpp / 8; | |
162 | fbdev->av1->y_count = fbdev->modes[mode].a_lines; | |
163 | fbdev->av1->y_modify = | |
164 | (fbdev->modes[mode].xres - fbdev->modes[mode].boeft_blank + | |
165 | 1) * (fbdev->modes[mode].bpp / 8); | |
166 | ||
167 | /* Vertical Blanking Field 2 */ | |
168 | ||
169 | fbdev->vb2->start_addr = VB_DUMMY_MEMORY_SOURCE; | |
170 | fbdev->vb2->cfg = DMA_CFG_VAL; | |
171 | fbdev->vb2->x_count = | |
172 | fbdev->modes[mode].xres + fbdev->modes[mode].boeft_blank; | |
173 | ||
174 | fbdev->vb2->x_modify = 0; | |
175 | fbdev->vb2->y_count = fbdev->modes[mode].vb2_lines; | |
176 | fbdev->vb2->y_modify = 0; | |
177 | ||
178 | /* Active Video Field 2 */ | |
179 | ||
180 | fbdev->av2->start_addr = | |
181 | (unsigned long)fbdev->fb_mem + fbdev->line_len; | |
182 | ||
183 | fbdev->av2->cfg = DMA_CFG_VAL; | |
184 | ||
185 | fbdev->av2->x_count = | |
186 | fbdev->modes[mode].xres + fbdev->modes[mode].boeft_blank; | |
187 | ||
188 | fbdev->av2->x_modify = (fbdev->modes[mode].bpp / 8); | |
189 | fbdev->av2->y_count = fbdev->modes[mode].a_lines; | |
190 | ||
191 | fbdev->av2->y_modify = | |
192 | (fbdev->modes[mode].xres - fbdev->modes[mode].boeft_blank + | |
193 | 1) * (fbdev->modes[mode].bpp / 8); | |
194 | ||
195 | return 1; | |
196 | } | |
197 | ||
198 | error: | |
199 | l1_data_sram_free(fbdev->vb1); | |
200 | l1_data_sram_free(fbdev->av1); | |
201 | l1_data_sram_free(fbdev->vb2); | |
202 | l1_data_sram_free(fbdev->av2); | |
203 | ||
204 | return 0; | |
205 | } | |
206 | ||
207 | static int bfin_config_dma(struct adv7393fb_device *fbdev) | |
208 | { | |
209 | BUG_ON(!(fbdev->fb_mem)); | |
210 | ||
211 | set_dma_x_count(CH_PPI, fbdev->descriptor_list_head->x_count); | |
212 | set_dma_x_modify(CH_PPI, fbdev->descriptor_list_head->x_modify); | |
213 | set_dma_y_count(CH_PPI, fbdev->descriptor_list_head->y_count); | |
214 | set_dma_y_modify(CH_PPI, fbdev->descriptor_list_head->y_modify); | |
215 | set_dma_start_addr(CH_PPI, fbdev->descriptor_list_head->start_addr); | |
216 | set_dma_next_desc_addr(CH_PPI, | |
217 | fbdev->descriptor_list_head->next_desc_addr); | |
218 | set_dma_config(CH_PPI, fbdev->descriptor_list_head->cfg); | |
219 | ||
220 | return 1; | |
221 | } | |
222 | ||
223 | static void bfin_disable_dma(void) | |
224 | { | |
225 | bfin_write_DMA0_CONFIG(bfin_read_DMA0_CONFIG() & ~DMAEN); | |
226 | } | |
227 | ||
228 | static void bfin_config_ppi(struct adv7393fb_device *fbdev) | |
229 | { | |
230 | if (ANOMALY_05000183) { | |
231 | bfin_write_TIMER2_CONFIG(WDTH_CAP); | |
232 | bfin_write_TIMER_ENABLE(TIMEN2); | |
233 | } | |
234 | ||
235 | bfin_write_PPI_CONTROL(0x381E); | |
236 | bfin_write_PPI_FRAME(fbdev->modes[mode].tot_lines); | |
237 | bfin_write_PPI_COUNT(fbdev->modes[mode].xres + | |
238 | fbdev->modes[mode].boeft_blank - 1); | |
239 | bfin_write_PPI_DELAY(fbdev->modes[mode].aoeft_blank - 1); | |
240 | } | |
241 | ||
242 | static void bfin_enable_ppi(void) | |
243 | { | |
244 | bfin_write_PPI_CONTROL(bfin_read_PPI_CONTROL() | PORT_EN); | |
245 | } | |
246 | ||
247 | static void bfin_disable_ppi(void) | |
248 | { | |
249 | bfin_write_PPI_CONTROL(bfin_read_PPI_CONTROL() & ~PORT_EN); | |
250 | } | |
251 | ||
252 | static inline int adv7393_write(struct i2c_client *client, u8 reg, u8 value) | |
253 | { | |
254 | return i2c_smbus_write_byte_data(client, reg, value); | |
255 | } | |
256 | ||
257 | static inline int adv7393_read(struct i2c_client *client, u8 reg) | |
258 | { | |
259 | return i2c_smbus_read_byte_data(client, reg); | |
260 | } | |
261 | ||
262 | static int | |
263 | adv7393_write_block(struct i2c_client *client, | |
264 | const u8 *data, unsigned int len) | |
265 | { | |
266 | int ret = -1; | |
267 | u8 reg; | |
268 | ||
269 | while (len >= 2) { | |
270 | reg = *data++; | |
271 | ret = adv7393_write(client, reg, *data++); | |
272 | if (ret < 0) | |
273 | break; | |
274 | len -= 2; | |
275 | } | |
276 | ||
277 | return ret; | |
278 | } | |
279 | ||
280 | static int adv7393_mode(struct i2c_client *client, u16 mode) | |
281 | { | |
282 | switch (mode) { | |
283 | case POWER_ON: /* ADV7393 Sleep mode OFF */ | |
284 | adv7393_write(client, 0x00, 0x1E); | |
285 | break; | |
286 | case POWER_DOWN: /* ADV7393 Sleep mode ON */ | |
287 | adv7393_write(client, 0x00, 0x1F); | |
288 | break; | |
289 | case BLANK_OFF: /* Pixel Data Valid */ | |
290 | adv7393_write(client, 0x82, 0xCB); | |
291 | break; | |
292 | case BLANK_ON: /* Pixel Data Invalid */ | |
293 | adv7393_write(client, 0x82, 0x8B); | |
294 | break; | |
295 | default: | |
296 | return -EINVAL; | |
297 | break; | |
298 | } | |
299 | return 0; | |
300 | } | |
301 | ||
302 | static irqreturn_t ppi_irq_error(int irq, void *dev_id) | |
303 | { | |
304 | ||
305 | struct adv7393fb_device *fbdev = (struct adv7393fb_device *)dev_id; | |
306 | ||
307 | u16 status = bfin_read_PPI_STATUS(); | |
308 | ||
309 | pr_debug("%s: PPI Status = 0x%X\n", __func__, status); | |
310 | ||
311 | if (status) { | |
312 | bfin_disable_dma(); /* TODO: Check Sequence */ | |
313 | bfin_disable_ppi(); | |
314 | bfin_clear_PPI_STATUS(); | |
315 | bfin_config_dma(fbdev); | |
316 | bfin_enable_ppi(); | |
317 | } | |
318 | ||
319 | return IRQ_HANDLED; | |
320 | ||
321 | } | |
322 | ||
323 | static int proc_output(char *buf) | |
324 | { | |
325 | char *p = buf; | |
326 | ||
327 | p += sprintf(p, | |
328 | "Usage:\n" | |
329 | "echo 0x[REG][Value] > adv7393\n" | |
330 | "example: echo 0x1234 >adv7393\n" | |
331 | "writes 0x34 into Register 0x12\n"); | |
332 | ||
333 | return p - buf; | |
334 | } | |
335 | ||
336 | static int | |
337 | adv7393_read_proc(char *page, char **start, off_t off, | |
338 | int count, int *eof, void *data) | |
339 | { | |
340 | int len; | |
341 | ||
342 | len = proc_output(page); | |
343 | if (len <= off + count) | |
344 | *eof = 1; | |
345 | *start = page + off; | |
346 | len -= off; | |
347 | if (len > count) | |
348 | len = count; | |
349 | if (len < 0) | |
350 | len = 0; | |
351 | return len; | |
352 | } | |
353 | ||
354 | static int | |
355 | adv7393_write_proc(struct file *file, const char __user * buffer, | |
356 | unsigned long count, void *data) | |
357 | { | |
358 | struct adv7393fb_device *fbdev = data; | |
359 | char line[8]; | |
360 | unsigned int val; | |
361 | int ret; | |
362 | ||
363 | ret = copy_from_user(line, buffer, count); | |
364 | if (ret) | |
365 | return -EFAULT; | |
366 | ||
367 | val = simple_strtoul(line, NULL, 0); | |
368 | adv7393_write(fbdev->client, val >> 8, val & 0xff); | |
369 | ||
370 | return count; | |
371 | } | |
372 | ||
373 | static int __devinit bfin_adv7393_fb_probe(struct i2c_client *client, | |
374 | const struct i2c_device_id *id) | |
375 | { | |
376 | int ret = 0; | |
377 | struct proc_dir_entry *entry; | |
378 | int num_modes = ARRAY_SIZE(known_modes); | |
379 | ||
380 | struct adv7393fb_device *fbdev = NULL; | |
381 | ||
382 | if (mem > 2) { | |
383 | dev_err(&client->dev, "mem out of allowed range [1;2]\n"); | |
384 | return -EINVAL; | |
385 | } | |
386 | ||
387 | if (mode > num_modes) { | |
388 | dev_err(&client->dev, "mode %d: not supported", mode); | |
389 | return -EFAULT; | |
390 | } | |
391 | ||
392 | fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL); | |
393 | if (!fbdev) { | |
394 | dev_err(&client->dev, "failed to allocate device private record"); | |
395 | return -ENOMEM; | |
396 | } | |
397 | ||
398 | i2c_set_clientdata(client, fbdev); | |
399 | ||
400 | fbdev->modes = known_modes; | |
401 | fbdev->client = client; | |
402 | ||
403 | fbdev->fb_len = | |
404 | mem * fbdev->modes[mode].xres * fbdev->modes[mode].xres * | |
405 | (fbdev->modes[mode].bpp / 8); | |
406 | ||
407 | fbdev->line_len = | |
408 | fbdev->modes[mode].xres * (fbdev->modes[mode].bpp / 8); | |
409 | ||
410 | /* Workaround "PPI Does Not Start Properly In Specific Mode" */ | |
411 | if (ANOMALY_05000400) { | |
f8bd4934 JH |
412 | ret = gpio_request_one(P_IDENT(P_PPI0_FS3), GPIOF_OUT_INIT_LOW, |
413 | "PPI0_FS3") | |
414 | if (ret) { | |
cffd9348 MH |
415 | dev_err(&client->dev, "PPI0_FS3 GPIO request failed\n"); |
416 | ret = -EBUSY; | |
417 | goto out_8; | |
418 | } | |
cffd9348 MH |
419 | } |
420 | ||
421 | if (peripheral_request_list(ppi_pins, DRIVER_NAME)) { | |
422 | dev_err(&client->dev, "requesting PPI peripheral failed\n"); | |
423 | ret = -EFAULT; | |
424 | goto out_8; | |
425 | } | |
426 | ||
427 | fbdev->fb_mem = | |
428 | dma_alloc_coherent(NULL, fbdev->fb_len, &fbdev->dma_handle, | |
429 | GFP_KERNEL); | |
430 | ||
431 | if (NULL == fbdev->fb_mem) { | |
432 | dev_err(&client->dev, "couldn't allocate dma buffer (%d bytes)\n", | |
433 | (u32) fbdev->fb_len); | |
434 | ret = -ENOMEM; | |
435 | goto out_7; | |
436 | } | |
437 | ||
438 | fbdev->info.screen_base = (void *)fbdev->fb_mem; | |
439 | bfin_adv7393_fb_fix.smem_start = (int)fbdev->fb_mem; | |
440 | ||
441 | bfin_adv7393_fb_fix.smem_len = fbdev->fb_len; | |
442 | bfin_adv7393_fb_fix.line_length = fbdev->line_len; | |
443 | ||
444 | if (mem > 1) | |
445 | bfin_adv7393_fb_fix.ypanstep = 1; | |
446 | ||
447 | bfin_adv7393_fb_defined.red.length = 5; | |
448 | bfin_adv7393_fb_defined.green.length = 6; | |
449 | bfin_adv7393_fb_defined.blue.length = 5; | |
450 | ||
451 | bfin_adv7393_fb_defined.xres = fbdev->modes[mode].xres; | |
452 | bfin_adv7393_fb_defined.yres = fbdev->modes[mode].yres; | |
453 | bfin_adv7393_fb_defined.xres_virtual = fbdev->modes[mode].xres; | |
454 | bfin_adv7393_fb_defined.yres_virtual = mem * fbdev->modes[mode].yres; | |
455 | bfin_adv7393_fb_defined.bits_per_pixel = fbdev->modes[mode].bpp; | |
456 | ||
457 | fbdev->info.fbops = &bfin_adv7393_fb_ops; | |
458 | fbdev->info.var = bfin_adv7393_fb_defined; | |
459 | fbdev->info.fix = bfin_adv7393_fb_fix; | |
460 | fbdev->info.par = &bfin_par; | |
461 | fbdev->info.flags = FBINFO_DEFAULT; | |
462 | ||
463 | fbdev->info.pseudo_palette = kzalloc(sizeof(u32) * 16, GFP_KERNEL); | |
464 | if (!fbdev->info.pseudo_palette) { | |
465 | dev_err(&client->dev, "failed to allocate pseudo_palette\n"); | |
466 | ret = -ENOMEM; | |
467 | goto out_6; | |
468 | } | |
469 | ||
470 | if (fb_alloc_cmap(&fbdev->info.cmap, BFIN_LCD_NBR_PALETTE_ENTRIES, 0) < 0) { | |
471 | dev_err(&client->dev, "failed to allocate colormap (%d entries)\n", | |
472 | BFIN_LCD_NBR_PALETTE_ENTRIES); | |
473 | ret = -EFAULT; | |
474 | goto out_5; | |
475 | } | |
476 | ||
477 | if (request_dma(CH_PPI, "BF5xx_PPI_DMA") < 0) { | |
478 | dev_err(&client->dev, "unable to request PPI DMA\n"); | |
479 | ret = -EFAULT; | |
480 | goto out_4; | |
481 | } | |
482 | ||
f8798ccb | 483 | if (request_irq(IRQ_PPI_ERROR, ppi_irq_error, 0, |
cffd9348 MH |
484 | "PPI ERROR", fbdev) < 0) { |
485 | dev_err(&client->dev, "unable to request PPI ERROR IRQ\n"); | |
486 | ret = -EFAULT; | |
487 | goto out_3; | |
488 | } | |
489 | ||
490 | fbdev->open = 0; | |
491 | ||
492 | ret = adv7393_write_block(client, fbdev->modes[mode].adv7393_i2c_initd, | |
493 | fbdev->modes[mode].adv7393_i2c_initd_len); | |
494 | ||
495 | if (ret) { | |
496 | dev_err(&client->dev, "i2c attach: init error\n"); | |
497 | goto out_1; | |
498 | } | |
499 | ||
500 | ||
501 | if (register_framebuffer(&fbdev->info) < 0) { | |
502 | dev_err(&client->dev, "unable to register framebuffer\n"); | |
503 | ret = -EFAULT; | |
504 | goto out_1; | |
505 | } | |
506 | ||
507 | dev_info(&client->dev, "fb%d: %s frame buffer device\n", | |
508 | fbdev->info.node, fbdev->info.fix.id); | |
509 | dev_info(&client->dev, "fb memory address : 0x%p\n", fbdev->fb_mem); | |
510 | ||
511 | entry = create_proc_entry("driver/adv7393", 0, NULL); | |
512 | if (!entry) { | |
513 | dev_err(&client->dev, "unable to create /proc entry\n"); | |
514 | ret = -EFAULT; | |
515 | goto out_0; | |
516 | } | |
517 | ||
518 | entry->read_proc = adv7393_read_proc; | |
519 | entry->write_proc = adv7393_write_proc; | |
520 | entry->data = fbdev; | |
521 | ||
522 | return 0; | |
523 | ||
524 | out_0: | |
525 | unregister_framebuffer(&fbdev->info); | |
526 | out_1: | |
527 | free_irq(IRQ_PPI_ERROR, fbdev); | |
528 | out_3: | |
529 | free_dma(CH_PPI); | |
530 | out_4: | |
531 | dma_free_coherent(NULL, fbdev->fb_len, fbdev->fb_mem, | |
532 | fbdev->dma_handle); | |
533 | out_5: | |
534 | fb_dealloc_cmap(&fbdev->info.cmap); | |
535 | out_6: | |
536 | kfree(fbdev->info.pseudo_palette); | |
537 | out_7: | |
538 | peripheral_free_list(ppi_pins); | |
539 | out_8: | |
540 | kfree(fbdev); | |
541 | ||
542 | return ret; | |
543 | } | |
544 | ||
545 | static int bfin_adv7393_fb_open(struct fb_info *info, int user) | |
546 | { | |
547 | struct adv7393fb_device *fbdev = to_adv7393fb_device(info); | |
548 | ||
549 | fbdev->info.screen_base = (void *)fbdev->fb_mem; | |
550 | if (!fbdev->info.screen_base) { | |
551 | dev_err(&fbdev->client->dev, "unable to map device\n"); | |
552 | return -ENOMEM; | |
553 | } | |
554 | ||
555 | fbdev->open = 1; | |
556 | dma_desc_list(fbdev, BUILD); | |
557 | adv7393_mode(fbdev->client, BLANK_OFF); | |
558 | bfin_config_ppi(fbdev); | |
559 | bfin_config_dma(fbdev); | |
560 | bfin_enable_ppi(); | |
561 | ||
562 | return 0; | |
563 | } | |
564 | ||
565 | static int bfin_adv7393_fb_release(struct fb_info *info, int user) | |
566 | { | |
567 | struct adv7393fb_device *fbdev = to_adv7393fb_device(info); | |
568 | ||
569 | adv7393_mode(fbdev->client, BLANK_ON); | |
570 | bfin_disable_dma(); | |
571 | bfin_disable_ppi(); | |
572 | dma_desc_list(fbdev, DESTRUCT); | |
573 | fbdev->open = 0; | |
574 | return 0; | |
575 | } | |
576 | ||
577 | static int | |
578 | bfin_adv7393_fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) | |
579 | { | |
580 | ||
581 | switch (var->bits_per_pixel) { | |
582 | case 16:/* DIRECTCOLOUR, 64k */ | |
583 | var->red.offset = info->var.red.offset; | |
584 | var->green.offset = info->var.green.offset; | |
585 | var->blue.offset = info->var.blue.offset; | |
586 | var->red.length = info->var.red.length; | |
587 | var->green.length = info->var.green.length; | |
588 | var->blue.length = info->var.blue.length; | |
589 | var->transp.offset = 0; | |
590 | var->transp.length = 0; | |
591 | var->transp.msb_right = 0; | |
592 | var->red.msb_right = 0; | |
593 | var->green.msb_right = 0; | |
594 | var->blue.msb_right = 0; | |
595 | break; | |
596 | default: | |
597 | pr_debug("%s: depth not supported: %u BPP\n", __func__, | |
598 | var->bits_per_pixel); | |
599 | return -EINVAL; | |
600 | } | |
601 | ||
602 | if (info->var.xres != var->xres || | |
603 | info->var.yres != var->yres || | |
604 | info->var.xres_virtual != var->xres_virtual || | |
605 | info->var.yres_virtual != var->yres_virtual) { | |
606 | pr_debug("%s: Resolution not supported: X%u x Y%u\n", | |
607 | __func__, var->xres, var->yres); | |
608 | return -EINVAL; | |
609 | } | |
610 | ||
611 | /* | |
612 | * Memory limit | |
613 | */ | |
614 | ||
615 | if ((info->fix.line_length * var->yres_virtual) > info->fix.smem_len) { | |
616 | pr_debug("%s: Memory Limit requested yres_virtual = %u\n", | |
617 | __func__, var->yres_virtual); | |
618 | return -ENOMEM; | |
619 | } | |
620 | ||
621 | return 0; | |
622 | } | |
623 | ||
624 | static int | |
625 | bfin_adv7393_fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info) | |
626 | { | |
627 | int dy; | |
628 | u32 dmaaddr; | |
629 | struct adv7393fb_device *fbdev = to_adv7393fb_device(info); | |
630 | ||
631 | if (!var || !info) | |
632 | return -EINVAL; | |
633 | ||
634 | if (var->xoffset - info->var.xoffset) { | |
635 | /* No support for X panning for now! */ | |
636 | return -EINVAL; | |
637 | } | |
638 | dy = var->yoffset - info->var.yoffset; | |
639 | ||
640 | if (dy) { | |
641 | pr_debug("%s: Panning screen of %d lines\n", __func__, dy); | |
642 | ||
643 | dmaaddr = fbdev->av1->start_addr; | |
644 | dmaaddr += (info->fix.line_length * dy); | |
645 | /* TODO: Wait for current frame to finished */ | |
646 | ||
647 | fbdev->av1->start_addr = (unsigned long)dmaaddr; | |
648 | fbdev->av2->start_addr = (unsigned long)dmaaddr + fbdev->line_len; | |
649 | } | |
650 | ||
651 | return 0; | |
652 | ||
653 | } | |
654 | ||
655 | /* 0 unblank, 1 blank, 2 no vsync, 3 no hsync, 4 off */ | |
656 | static int bfin_adv7393_fb_blank(int blank, struct fb_info *info) | |
657 | { | |
658 | struct adv7393fb_device *fbdev = to_adv7393fb_device(info); | |
659 | ||
660 | switch (blank) { | |
661 | ||
662 | case VESA_NO_BLANKING: | |
663 | /* Turn on panel */ | |
664 | adv7393_mode(fbdev->client, BLANK_OFF); | |
665 | break; | |
666 | ||
667 | case VESA_VSYNC_SUSPEND: | |
668 | case VESA_HSYNC_SUSPEND: | |
669 | case VESA_POWERDOWN: | |
670 | /* Turn off panel */ | |
671 | adv7393_mode(fbdev->client, BLANK_ON); | |
672 | break; | |
673 | ||
674 | default: | |
675 | return -EINVAL; | |
676 | break; | |
677 | } | |
678 | return 0; | |
679 | } | |
680 | ||
681 | int bfin_adv7393_fb_cursor(struct fb_info *info, struct fb_cursor *cursor) | |
682 | { | |
683 | if (nocursor) | |
684 | return 0; | |
685 | else | |
686 | return -EINVAL; /* just to force soft_cursor() call */ | |
687 | } | |
688 | ||
689 | static int bfin_adv7393_fb_setcolreg(u_int regno, u_int red, u_int green, | |
690 | u_int blue, u_int transp, | |
691 | struct fb_info *info) | |
692 | { | |
693 | if (regno >= BFIN_LCD_NBR_PALETTE_ENTRIES) | |
694 | return -EINVAL; | |
695 | ||
696 | if (info->var.grayscale) | |
697 | /* grayscale = 0.30*R + 0.59*G + 0.11*B */ | |
698 | red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8; | |
699 | ||
700 | if (info->fix.visual == FB_VISUAL_TRUECOLOR) { | |
701 | u32 value; | |
702 | /* Place color in the pseudopalette */ | |
703 | if (regno > 16) | |
704 | return -EINVAL; | |
705 | ||
706 | red >>= (16 - info->var.red.length); | |
707 | green >>= (16 - info->var.green.length); | |
708 | blue >>= (16 - info->var.blue.length); | |
709 | ||
710 | value = (red << info->var.red.offset) | | |
711 | (green << info->var.green.offset)| | |
712 | (blue << info->var.blue.offset); | |
713 | value &= 0xFFFF; | |
714 | ||
715 | ((u32 *) (info->pseudo_palette))[regno] = value; | |
716 | } | |
717 | ||
718 | return 0; | |
719 | } | |
720 | ||
721 | static int __devexit bfin_adv7393_fb_remove(struct i2c_client *client) | |
722 | { | |
723 | struct adv7393fb_device *fbdev = i2c_get_clientdata(client); | |
724 | ||
725 | adv7393_mode(client, POWER_DOWN); | |
726 | ||
727 | if (fbdev->fb_mem) | |
728 | dma_free_coherent(NULL, fbdev->fb_len, fbdev->fb_mem, fbdev->dma_handle); | |
729 | free_dma(CH_PPI); | |
730 | free_irq(IRQ_PPI_ERROR, fbdev); | |
731 | unregister_framebuffer(&fbdev->info); | |
732 | remove_proc_entry("driver/adv7393", NULL); | |
733 | fb_dealloc_cmap(&fbdev->info.cmap); | |
734 | kfree(fbdev->info.pseudo_palette); | |
735 | ||
736 | if (ANOMALY_05000400) | |
737 | gpio_free(P_IDENT(P_PPI0_FS3)); /* FS3 */ | |
738 | peripheral_free_list(ppi_pins); | |
739 | kfree(fbdev); | |
740 | ||
741 | return 0; | |
742 | } | |
743 | ||
744 | #ifdef CONFIG_PM | |
745 | static int bfin_adv7393_fb_suspend(struct device *dev) | |
746 | { | |
747 | struct adv7393fb_device *fbdev = dev_get_drvdata(dev); | |
748 | ||
749 | if (fbdev->open) { | |
750 | bfin_disable_dma(); | |
751 | bfin_disable_ppi(); | |
752 | dma_desc_list(fbdev, DESTRUCT); | |
753 | } | |
754 | adv7393_mode(fbdev->client, POWER_DOWN); | |
755 | ||
756 | return 0; | |
757 | } | |
758 | ||
759 | static int bfin_adv7393_fb_resume(struct device *dev) | |
760 | { | |
761 | struct adv7393fb_device *fbdev = dev_get_drvdata(dev); | |
762 | ||
763 | adv7393_mode(fbdev->client, POWER_ON); | |
764 | ||
765 | if (fbdev->open) { | |
766 | dma_desc_list(fbdev, BUILD); | |
767 | bfin_config_ppi(fbdev); | |
768 | bfin_config_dma(fbdev); | |
769 | bfin_enable_ppi(); | |
770 | } | |
771 | ||
772 | return 0; | |
773 | } | |
774 | ||
775 | static const struct dev_pm_ops bfin_adv7393_dev_pm_ops = { | |
776 | .suspend = bfin_adv7393_fb_suspend, | |
777 | .resume = bfin_adv7393_fb_resume, | |
778 | }; | |
779 | #endif | |
780 | ||
781 | static const struct i2c_device_id bfin_adv7393_id[] = { | |
782 | {DRIVER_NAME, 0}, | |
783 | {} | |
784 | }; | |
785 | ||
786 | MODULE_DEVICE_TABLE(i2c, bfin_adv7393_id); | |
787 | ||
788 | static struct i2c_driver bfin_adv7393_fb_driver = { | |
789 | .driver = { | |
790 | .name = DRIVER_NAME, | |
791 | #ifdef CONFIG_PM | |
792 | .pm = &bfin_adv7393_dev_pm_ops, | |
793 | #endif | |
794 | }, | |
795 | .probe = bfin_adv7393_fb_probe, | |
796 | .remove = __devexit_p(bfin_adv7393_fb_remove), | |
797 | .id_table = bfin_adv7393_id, | |
798 | }; | |
799 | ||
800 | static int __init bfin_adv7393_fb_driver_init(void) | |
801 | { | |
802 | #if defined(CONFIG_I2C_BLACKFIN_TWI) || defined(CONFIG_I2C_BLACKFIN_TWI_MODULE) | |
803 | request_module("i2c-bfin-twi"); | |
804 | #else | |
805 | request_module("i2c-gpio"); | |
806 | #endif | |
807 | ||
808 | return i2c_add_driver(&bfin_adv7393_fb_driver); | |
809 | } | |
810 | module_init(bfin_adv7393_fb_driver_init); | |
811 | ||
812 | static void __exit bfin_adv7393_fb_driver_cleanup(void) | |
813 | { | |
814 | i2c_del_driver(&bfin_adv7393_fb_driver); | |
815 | } | |
816 | module_exit(bfin_adv7393_fb_driver_cleanup); | |
817 | ||
818 | MODULE_LICENSE("GPL"); | |
819 | MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); | |
820 | MODULE_DESCRIPTION("Frame buffer driver for ADV7393/2 Video Encoder"); | |
821 | ||
822 | module_param(mode, int, 0); | |
823 | MODULE_PARM_DESC(mode, | |
824 | "Video Mode (0=NTSC,1=PAL,2=NTSC 640x480,3=PAL 640x480,4=NTSC YCbCr input,5=PAL YCbCr input)"); | |
825 | ||
826 | module_param(mem, int, 0); | |
827 | MODULE_PARM_DESC(mem, | |
828 | "Size of frame buffer memory 1=Single 2=Double Size (allows y-panning / frame stacking)"); | |
829 | ||
830 | module_param(nocursor, int, 0644); | |
831 | MODULE_PARM_DESC(nocursor, "cursor enable/disable"); |