RT-AC56 3.0.0.4.374.37 core
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / arch / sh / boards / mach-migor / lcd_qvga.c
blobde9014a8a93ed3fffa961582f6bbfe960d33803a
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 *board_data, void *sohandle,
117 struct sh_mobile_lcdc_sys_bus_ops *so)
119 unsigned long xres = 320;
120 unsigned long yres = 240;
121 int k;
123 reset_lcd_module();
124 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
126 if (read_reg16(sohandle, so, 0) != 0x1505)
127 return -ENODEV;
129 pr_info("Migo-R QVGA LCD Module detected.\n");
131 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
132 write_reg16(sohandle, so, 0x00A4, 0x0001);
133 mdelay(10);
135 migor_lcd_qvga_seq(sohandle, so, magic0_data, ARRAY_SIZE(magic0_data));
136 mdelay(100);
138 migor_lcd_qvga_seq(sohandle, so, magic1_data, ARRAY_SIZE(magic1_data));
139 write_reg16(sohandle, so, 0x0050, 0xef - (yres - 1));
140 write_reg16(sohandle, so, 0x0051, 0x00ef);
141 write_reg16(sohandle, so, 0x0052, 0x0000);
142 write_reg16(sohandle, so, 0x0053, xres - 1);
144 migor_lcd_qvga_seq(sohandle, so, magic2_data, ARRAY_SIZE(magic2_data));
145 mdelay(10);
147 migor_lcd_qvga_seq(sohandle, so, magic3_data, ARRAY_SIZE(magic3_data));
148 mdelay(40);
150 /* clear GRAM to avoid displaying garbage */
152 write_reg16(sohandle, so, 0x0020, 0x0000); /* horiz addr */
153 write_reg16(sohandle, so, 0x0021, 0x0000); /* vert addr */
155 for (k = 0; k < (xres * 256); k++) /* yes, 256 words per line */
156 write_reg16(sohandle, so, 0x0022, 0x0000);
158 write_reg16(sohandle, so, 0x0020, 0x0000); /* reset horiz addr */
159 write_reg16(sohandle, so, 0x0021, 0x0000); /* reset vert addr */
160 write_reg16(sohandle, so, 0x0007, 0x0173);
161 mdelay(40);
163 /* enable display */
164 write_reg(sohandle, so, 0x00, 0x22);
165 mdelay(100);
166 return 0;