1
2
3
4
5
6
7
8
9
10
11#include <linux/delay.h>
12#include <linux/err.h>
13#include <linux/fb.h>
14#include <linux/init.h>
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/gpio.h>
18#include <video/sh_mobile_lcdc.h>
19#include <cpu/sh7722.h>
20#include <mach/migor.h>
21
22
23
24
25
26
27
28
29
30static void reset_lcd_module(void)
31{
32 gpio_set_value(GPIO_PTH2, 0);
33 mdelay(2);
34 gpio_set_value(GPIO_PTH2, 1);
35 mdelay(1);
36}
37
38
39
40static unsigned long adjust_reg18(unsigned short data)
41{
42 unsigned long tmp1, tmp2;
43
44 tmp1 = (data<<1 | 0x00000001) & 0x000001FF;
45 tmp2 = (data<<2 | 0x00000200) & 0x0003FE00;
46 return tmp1 | tmp2;
47}
48
49static void write_reg(void *sys_ops_handle,
50 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
51 unsigned short reg, unsigned short data)
52{
53 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg << 8 | data));
54}
55
56static void write_reg16(void *sys_ops_handle,
57 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
58 unsigned short reg, unsigned short data)
59{
60 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg));
61 sys_ops->write_data(sys_ops_handle, adjust_reg18(data));
62}
63
64static unsigned long read_reg16(void *sys_ops_handle,
65 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
66 unsigned short reg)
67{
68 unsigned long data;
69
70 sys_ops->write_index(sys_ops_handle, adjust_reg18(reg));
71 data = sys_ops->read_data(sys_ops_handle);
72 return ((data >> 1) & 0xff) | ((data >> 2) & 0xff00);
73}
74
75static void migor_lcd_qvga_seq(void *sys_ops_handle,
76 struct sh_mobile_lcdc_sys_bus_ops *sys_ops,
77 unsigned short const *data, int no_data)
78{
79 int i;
80
81 for (i = 0; i < no_data; i += 2)
82 write_reg16(sys_ops_handle, sys_ops, data[i], data[i + 1]);
83}
84
85static const unsigned short sync_data[] = {
86 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
87};
88
89static const unsigned short magic0_data[] = {
90 0x0060, 0x2700, 0x0008, 0x0808, 0x0090, 0x001A, 0x0007, 0x0001,
91 0x0017, 0x0001, 0x0019, 0x0000, 0x0010, 0x17B0, 0x0011, 0x0116,
92 0x0012, 0x0198, 0x0013, 0x1400, 0x0029, 0x000C, 0x0012, 0x01B8,
93};
94
95static const unsigned short magic1_data[] = {
96 0x0030, 0x0307, 0x0031, 0x0303, 0x0032, 0x0603, 0x0033, 0x0202,
97 0x0034, 0x0202, 0x0035, 0x0202, 0x0036, 0x1F1F, 0x0037, 0x0303,
98 0x0038, 0x0303, 0x0039, 0x0603, 0x003A, 0x0202, 0x003B, 0x0102,
99 0x003C, 0x0204, 0x003D, 0x0000, 0x0001, 0x0100, 0x0002, 0x0300,
100 0x0003, 0x5028, 0x0020, 0x00ef, 0x0021, 0x0000, 0x0004, 0x0000,
101 0x0009, 0x0000, 0x000A, 0x0008, 0x000C, 0x0000, 0x000D, 0x0000,
102 0x0015, 0x8000,
103};
104
105static const unsigned short magic2_data[] = {
106 0x0061, 0x0001, 0x0092, 0x0100, 0x0093, 0x0001, 0x0007, 0x0021,
107};
108
109static const unsigned short magic3_data[] = {
110 0x0010, 0x16B0, 0x0011, 0x0111, 0x0007, 0x0061,
111};
112
113int migor_lcd_qvga_setup(void *sohandle, struct sh_mobile_lcdc_sys_bus_ops *so)
114{
115 unsigned long xres = 320;
116 unsigned long yres = 240;
117 int k;
118
119 reset_lcd_module();
120 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
121
122 if (read_reg16(sohandle, so, 0) != 0x1505)
123 return -ENODEV;
124
125 pr_info("Migo-R QVGA LCD Module detected.\n");
126
127 migor_lcd_qvga_seq(sohandle, so, sync_data, ARRAY_SIZE(sync_data));
128 write_reg16(sohandle, so, 0x00A4, 0x0001);
129 mdelay(10);
130
131 migor_lcd_qvga_seq(sohandle, so, magic0_data, ARRAY_SIZE(magic0_data));
132 mdelay(100);
133
134 migor_lcd_qvga_seq(sohandle, so, magic1_data, ARRAY_SIZE(magic1_data));
135 write_reg16(sohandle, so, 0x0050, 0xef - (yres - 1));
136 write_reg16(sohandle, so, 0x0051, 0x00ef);
137 write_reg16(sohandle, so, 0x0052, 0x0000);
138 write_reg16(sohandle, so, 0x0053, xres - 1);
139
140 migor_lcd_qvga_seq(sohandle, so, magic2_data, ARRAY_SIZE(magic2_data));
141 mdelay(10);
142
143 migor_lcd_qvga_seq(sohandle, so, magic3_data, ARRAY_SIZE(magic3_data));
144 mdelay(40);
145
146
147
148 write_reg16(sohandle, so, 0x0020, 0x0000);
149 write_reg16(sohandle, so, 0x0021, 0x0000);
150
151 for (k = 0; k < (xres * 256); k++)
152 write_reg16(sohandle, so, 0x0022, 0x0000);
153
154 write_reg16(sohandle, so, 0x0020, 0x0000);
155 write_reg16(sohandle, so, 0x0021, 0x0000);
156 write_reg16(sohandle, so, 0x0007, 0x0173);
157 mdelay(40);
158
159
160 write_reg(sohandle, so, 0x00, 0x22);
161 mdelay(100);
162 return 0;
163}
164