1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/module.h>
22#include <linux/kernel.h>
23#include <linux/init.h>
24#include <linux/gpio.h>
25#include <linux/delay.h>
26
27#include "fbtft.h"
28
29#define DRVNAME "fb_upd161704"
30#define WIDTH 240
31#define HEIGHT 320
32#define BPP 16
33
34static int init_display(struct fbtft_par *par)
35{
36 par->fbtftops.reset(par);
37
38 if (par->gpio.cs != -1)
39 gpio_set_value(par->gpio.cs, 0);
40
41
42
43
44 write_reg(par, 0x0003, 0x0001);
45
46
47 write_reg(par, 0x003A, 0x0001);
48 udelay(100);
49
50
51 write_reg(par, 0x0024, 0x007B);
52 udelay(10);
53 write_reg(par, 0x0025, 0x003B);
54 write_reg(par, 0x0026, 0x0034);
55 udelay(10);
56 write_reg(par, 0x0027, 0x0004);
57 write_reg(par, 0x0052, 0x0025);
58 udelay(10);
59 write_reg(par, 0x0053, 0x0033);
60 write_reg(par, 0x0061, 0x001C);
61 udelay(10);
62 write_reg(par, 0x0062, 0x002C);
63 write_reg(par, 0x0063, 0x0022);
64 udelay(10);
65 write_reg(par, 0x0064, 0x0027);
66 udelay(10);
67 write_reg(par, 0x0065, 0x0014);
68 udelay(10);
69 write_reg(par, 0x0066, 0x0010);
70
71
72 write_reg(par, 0x002E, 0x002D);
73
74
75 write_reg(par, 0x0019, 0x0000);
76 udelay(200);
77 write_reg(par, 0x001A, 0x1000);
78 write_reg(par, 0x001B, 0x0023);
79 write_reg(par, 0x001C, 0x0C01);
80 write_reg(par, 0x001D, 0x0000);
81 write_reg(par, 0x001E, 0x0009);
82 write_reg(par, 0x001F, 0x0035);
83 write_reg(par, 0x0020, 0x0015);
84 write_reg(par, 0x0018, 0x1E7B);
85
86
87 write_reg(par, 0x0008, 0x0000);
88 write_reg(par, 0x0009, 0x00EF);
89 write_reg(par, 0x000a, 0x0000);
90 write_reg(par, 0x000b, 0x013F);
91
92
93 write_reg(par, 0x0029, 0x0000);
94 write_reg(par, 0x002A, 0x0000);
95 write_reg(par, 0x002B, 0x00EF);
96 write_reg(par, 0x002C, 0x013F);
97
98
99 write_reg(par, 0x0032, 0x0002);
100
101
102 write_reg(par, 0x0033, 0x0000);
103
104
105 write_reg(par, 0x0037, 0x0000);
106
107
108 write_reg(par, 0x003B, 0x0001);
109
110
111
112 write_reg(par, 0x0004, 0x0000);
113
114
115 write_reg(par, 0x0005, 0x0000);
116
117
118 write_reg(par, 0x0001, 0x0000);
119
120
121 write_reg(par, 0x0000, 0x0000);
122
123 return 0;
124}
125
126static void set_addr_win(struct fbtft_par *par, int xs, int ys, int xe, int ye)
127{
128 switch (par->info->var.rotate) {
129
130
131 case 0:
132 write_reg(par, 0x0006, xs);
133 write_reg(par, 0x0007, ys);
134 break;
135 case 180:
136 write_reg(par, 0x0006, WIDTH - 1 - xs);
137 write_reg(par, 0x0007, HEIGHT - 1 - ys);
138 break;
139 case 270:
140 write_reg(par, 0x0006, WIDTH - 1 - ys);
141 write_reg(par, 0x0007, xs);
142 break;
143 case 90:
144 write_reg(par, 0x0006, ys);
145 write_reg(par, 0x0007, HEIGHT - 1 - xs);
146 break;
147 }
148
149 write_reg(par, 0x0e);
150}
151
152static int set_var(struct fbtft_par *par)
153{
154 switch (par->info->var.rotate) {
155
156 case 0:
157 write_reg(par, 0x01, 0x0000);
158 write_reg(par, 0x05, 0x0000);
159 break;
160 case 180:
161 write_reg(par, 0x01, 0x00C0);
162 write_reg(par, 0x05, 0x0000);
163 break;
164 case 270:
165 write_reg(par, 0x01, 0x0080);
166 write_reg(par, 0x05, 0x0001);
167 break;
168 case 90:
169 write_reg(par, 0x01, 0x0040);
170 write_reg(par, 0x05, 0x0001);
171 break;
172 }
173
174 return 0;
175}
176
177static struct fbtft_display display = {
178 .regwidth = 16,
179 .width = WIDTH,
180 .height = HEIGHT,
181 .fbtftops = {
182 .init_display = init_display,
183 .set_addr_win = set_addr_win,
184 .set_var = set_var,
185 },
186};
187
188FBTFT_REGISTER_DRIVER(DRVNAME, "nec,upd161704", &display);
189
190MODULE_ALIAS("spi:" DRVNAME);
191MODULE_ALIAS("platform:" DRVNAME);
192MODULE_ALIAS("spi:upd161704");
193MODULE_ALIAS("platform:upd161704");
194
195MODULE_DESCRIPTION("FB driver for the uPD161704 LCD Controller");
196MODULE_AUTHOR("Seong-Woo Kim");
197MODULE_LICENSE("GPL");
198