hugetlb: introduce generic version of hugetlb_free_pgd_range
[linux/fpc-iii.git] / arch / sh / boards / mach-migor / lcd_qvga.c
blob8bccd345b69c24a577fb860ae1a6290d81c97e8e
1 /*
2 * Support for SuperH MigoR Quarter VGA LCD Panel
4 * Copyright (C) 2008 Magnus Damm
6 * Based on lcd_powertip.c from Kenati Technologies Pvt Ltd.
7 * Copyright (c) 2007 Ujjwal Pande <ujjwal@kenati.com>,
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
14 #include <linux/delay.h>
15 #include <linux/err.h>
16 #include <linux/fb.h>
17 #include <linux/init.h>
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/gpio.h>
21 #include <video/sh_mobile_lcdc.h>
22 #include <cpu/sh7722.h>
23 #include <mach/migor.h>
25 /* LCD Module is a PH240320T according to board schematics. This module
26 * is made up of a 240x320 LCD hooked up to a R61505U (or HX8347-A01?)
27 * Driver IC. This IC is connected to the SH7722 built-in LCDC using a
28 * SYS-80 interface configured in 16 bit mode.
30 * Index 0: "Device Code Read" returns 0x1505.
33 static void reset_lcd_module(void)
35 gpio_set_value(GPIO_PTH2, 0);
36 mdelay(2);
37 gpio_set_value(GPIO_PTH2, 1);
38 mdelay(1);
41 /* DB0-DB7 are connected to D1-D8, and DB8-DB15 to D10-D17 */
43 static unsigned long adjust_reg18(unsigned short data)
45 unsigned long tmp1, tmp2;
47 tmp1 = (data<<1 | 0x00000001) & 0x000001FF;
48 tmp2 = (data<<2 | 0x00000200) & 0x0003FE00;
49 return tmp1 | tmp2;
52 static void write_reg(void *sys_ops_handle,
53 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
54 unsigned short reg, unsigned short data)
56 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg << 8 | data));
59 static void write_reg16(void *sys_ops_handle,
60 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
61 unsigned short reg, unsigned short data)
63 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg));
64 sys_ops->write_data(sys_ops_handle, adjust_reg18(data));
67 static unsigned long read_reg16(void *sys_ops_handle,
68 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
69 unsigned short reg)
71 unsigned long data;
73 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg));
74 data = sys_ops->read_data(sys_ops_handle);
75 return ((data >> 1) & 0xff) | ((data >> 2) & 0xff00);
78 static void migor_lcd_qvga_seq(void *sys_ops_handle,
79 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
80 unsigned short const *data, int no_data)
82 int i;
84 for (i = 0; i < no_data; i += 2)
85 write_reg16(sys_ops_handle, sys_ops, data[i], data[i + 1]);
88 static const unsigned short sync_data[] = {
89 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
92 static const unsigned short magic0_data[] = {
93 0x0060, 0x2700, 0x0008, 0x0808, 0x0090, 0x001A, 0x0007, 0x0001,
94 0x0017, 0x0001, 0x0019, 0x0000, 0x0010, 0x17B0, 0x0011, 0x0116,
95 0x0012, 0x0198, 0x0013, 0x1400, 0x0029, 0x000C, 0x0012, 0x01B8,
98 static const unsigned short magic1_data[] = {
99 0x0030, 0x0307, 0x0031, 0x0303, 0x0032, 0x0603, 0x0033, 0x0202,
100 0x0034, 0x0202, 0x0035, 0x0202, 0x0036, 0x1F1F, 0x0037, 0x0303,
101 0x0038, 0x0303, 0x0039, 0x0603, 0x003A, 0x0202, 0x003B, 0x0102,
102 0x003C, 0x0204, 0x003D, 0x0000, 0x0001, 0x0100, 0x0002, 0x0300,
103 0x0003, 0x5028, 0x0020, 0x00ef, 0x0021, 0x0000, 0x0004, 0x0000,
104 0x0009, 0x0000, 0x000A, 0x0008, 0x000C, 0x0000, 0x000D, 0x0000,
105 0x0015, 0x8000,
108 static const unsigned short magic2_data[] = {
109 0x0061, 0x0001, 0x0092, 0x0100, 0x0093, 0x0001, 0x0007, 0x0021,
112 static const unsigned short magic3_data[] = {
113 0x0010, 0x16B0, 0x0011, 0x0111, 0x0007, 0x0061,
116 int migor_lcd_qvga_setup(void *sohandle, struct sh_mobile_lcdc_sys_bus_ops *so)
118 unsigned long xres = 320;
119 unsigned long yres = 240;
120 int k;
122 reset_lcd_module();
123 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
125 if (read_reg16(sohandle, so, 0) != 0x1505)
126 return -ENODEV;
128 pr_info("Migo-R QVGA LCD Module detected.\n");
130 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
131 write_reg16(sohandle, so, 0x00A4, 0x0001);
132 mdelay(10);
134 migor_lcd_qvga_seq(sohandle, so, magic0_data, ARRAY_SIZE(magic0_data));
135 mdelay(100);
137 migor_lcd_qvga_seq(sohandle, so, magic1_data, ARRAY_SIZE(magic1_data));
138 write_reg16(sohandle, so, 0x0050, 0xef - (yres - 1));
139 write_reg16(sohandle, so, 0x0051, 0x00ef);
140 write_reg16(sohandle, so, 0x0052, 0x0000);
141 write_reg16(sohandle, so, 0x0053, xres - 1);
143 migor_lcd_qvga_seq(sohandle, so, magic2_data, ARRAY_SIZE(magic2_data));
144 mdelay(10);
146 migor_lcd_qvga_seq(sohandle, so, magic3_data, ARRAY_SIZE(magic3_data));
147 mdelay(40);
149 /* clear GRAM to avoid displaying garbage */
151 write_reg16(sohandle, so, 0x0020, 0x0000); /* horiz addr */
152 write_reg16(sohandle, so, 0x0021, 0x0000); /* vert addr */
154 for (k = 0; k < (xres * 256); k++) /* yes, 256 words per line */
155 write_reg16(sohandle, so, 0x0022, 0x0000);
157 write_reg16(sohandle, so, 0x0020, 0x0000); /* reset horiz addr */
158 write_reg16(sohandle, so, 0x0021, 0x0000); /* reset vert addr */
159 write_reg16(sohandle, so, 0x0007, 0x0173);
160 mdelay(40);
162 /* enable display */
163 write_reg(sohandle, so, 0x00, 0x22);
164 mdelay(100);
165 return 0;