1
2
3
4
5
6
7
8
9
10#include <common.h>
11
12#include <video_fb.h>
13#include <sed13806.h>
14
15#define readByte(ptrReg) \
16 *(volatile unsigned char *)(sed13806.isaBase + ptrReg)
17
18#define writeByte(ptrReg,value) \
19 *(volatile unsigned char *)(sed13806.isaBase + ptrReg) = value
20
21#ifdef CONFIG_TOTAL5200
22#define writeWord(ptrReg,value) \
23 (*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = value)
24#else
25#define writeWord(ptrReg,value) \
26 (*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = ((value >> 8 ) & 0xff) | ((value << 8) & 0xff00))
27#endif
28
29GraphicDevice sed13806;
30
31
32
33
34
35static void EpsonSetRegs (void)
36{
37
38 const S1D_REGS *preg = board_get_regs ();
39 while (preg -> Index) {
40 writeByte (preg -> Index, preg -> Value);
41 preg ++;
42 }
43}
44
45
46
47
48
49void *video_hw_init (void)
50{
51 unsigned int *vm, i;
52
53 memset (&sed13806, 0, sizeof (GraphicDevice));
54
55
56
57
58 if ((sed13806.isaBase = board_video_init ()) == 0) {
59 return (NULL);
60 }
61
62 sed13806.frameAdrs = sed13806.isaBase + FRAME_BUFFER_OFFSET;
63 sed13806.winSizeX = board_get_width ();
64 sed13806.winSizeY = board_get_height ();
65
66#if defined(CONFIG_VIDEO_SED13806_8BPP)
67 sed13806.gdfIndex = GDF__8BIT_INDEX;
68 sed13806.gdfBytesPP = 1;
69
70#elif defined(CONFIG_VIDEO_SED13806_16BPP)
71 sed13806.gdfIndex = GDF_16BIT_565RGB;
72 sed13806.gdfBytesPP = 2;
73
74#else
75#error Unsupported SED13806 BPP
76#endif
77
78 sed13806.memSize = sed13806.winSizeX * sed13806.winSizeY * sed13806.gdfBytesPP;
79
80
81 EpsonSetRegs ();
82
83
84 board_validate_screen (sed13806.isaBase);
85
86
87 i = sed13806.memSize/4;
88 vm = (unsigned int *)sed13806.frameAdrs;
89 while(i--)
90 *vm++ = 0;
91
92
93 return (&sed13806);
94}
95
96
97
98
99static void Epson_wait_idle (void)
100{
101 while (readByte (BLT_CTRL0) & 0x80);
102
103
104 *(volatile unsigned short *)(sed13806.isaBase + BLT_REG);
105}
106
107
108
109
110
111void video_hw_bitblt (
112 unsigned int bpp,
113 unsigned int src_x,
114 unsigned int src_y,
115 unsigned int dst_x,
116 unsigned int dst_y,
117 unsigned int dim_x,
118 unsigned int dim_y
119 )
120{
121 register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
122 unsigned long srcAddr, dstAddr;
123 unsigned int stride = bpp * pGD -> winSizeX;
124
125 srcAddr = (src_y * stride) + (src_x * bpp);
126 dstAddr = (dst_y * stride) + (dst_x * bpp);
127
128 Epson_wait_idle ();
129
130 writeByte(BLT_ROP,0x0C);
131 writeByte(BLT_OP,0x02);
132 writeWord(BLT_MEM_OFF0, stride / 2);
133 if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
134 writeByte(BLT_CTRL1,0x00);
135 }
136 else {
137 writeByte(BLT_CTRL1,0x01);
138 }
139
140 writeWord(BLT_WIDTH0,(dim_x - 1));
141 writeWord(BLT_HEIGHT0,(dim_y - 1));
142
143
144 writeByte(BLT_SRC_ADDR0,srcAddr);
145 writeByte(BLT_SRC_ADDR1,srcAddr>>8);
146 writeByte(BLT_SRC_ADDR2,srcAddr>>16);
147
148 writeByte(BLT_DST_ADDR0,dstAddr);
149 writeByte(BLT_DST_ADDR1,dstAddr>>8);
150 writeByte(BLT_DST_ADDR2,dstAddr>>16);
151
152
153
154 writeByte(BLT_CTRL0,0x80);
155
156
157 Epson_wait_idle ();
158}
159
160
161
162
163void video_hw_rectfill (
164 unsigned int bpp,
165 unsigned int dst_x,
166 unsigned int dst_y,
167 unsigned int dim_x,
168 unsigned int dim_y,
169 unsigned int color
170 )
171{
172 register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
173 unsigned long dstAddr;
174 unsigned int stride = bpp * pGD -> winSizeX;
175
176 dstAddr = (dst_y * stride) + (dst_x * bpp);
177
178 Epson_wait_idle ();
179
180
181 writeByte(BLT_DST_ADDR0,dstAddr);
182 writeByte(BLT_DST_ADDR1,dstAddr>>8);
183 writeByte(BLT_DST_ADDR2,dstAddr>>16);
184
185 writeWord(BLT_WIDTH0,(dim_x - 1));
186 writeWord(BLT_HEIGHT0,(dim_y - 1));
187 writeWord(BLT_FGCOLOR0,color);
188
189 writeByte(BLT_OP,0x0C);
190 writeWord(BLT_MEM_OFF0,stride / 2);
191
192 if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
193 writeByte(BLT_CTRL1,0x00);
194 }
195 else {
196 writeByte(BLT_CTRL1,0x01);
197 }
198
199
200
201 writeByte(BLT_CTRL0,0x80);
202
203
204 Epson_wait_idle ();
205}
206
207
208
209
210
211void video_set_lut (
212 unsigned int index,
213 unsigned char r,
214 unsigned char g,
215 unsigned char b
216 )
217{
218 writeByte(REG_LUT_ADDR, index );
219 writeByte(REG_LUT_DATA, r);
220 writeByte(REG_LUT_DATA, g);
221 writeByte(REG_LUT_DATA, b);
222}
223#ifdef CONFIG_VIDEO_HW_CURSOR
224
225
226
227
228void video_set_hw_cursor (int x, int y)
229{
230 writeByte (LCD_CURSOR_XL, (x & 0xff));
231 writeByte (LCD_CURSOR_XM, (x >> 8));
232 writeByte (LCD_CURSOR_YL, (y & 0xff));
233 writeByte (LCD_CURSOR_YM, (y >> 8));
234}
235
236
237
238
239
240void video_init_hw_cursor (int font_width, int font_height)
241{
242 volatile unsigned char *ptr;
243 unsigned char pattern;
244 int i;
245
246
247
248
249
250 if ((i = readByte (LCD_CURSOR_START)) == 0) {
251 ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - HWCURSORSIZE);
252 }
253 else {
254 ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - (i * 8192));
255 }
256
257
258 for (i = 0, pattern = 0; i < 64; i++) {
259 if (i < font_width) {
260
261 pattern |= 0x3;
262
263 }
264 else {
265
266 pattern |= 0x2;
267 }
268 if ((i & 3) == 3) {
269 *ptr = pattern;
270 *(ptr + font_height * 16) = 0xaa;
271 ptr ++;
272 pattern = 0;
273 }
274 pattern <<= 2;
275 }
276
277
278 for (i = 1; i < font_height; i++) {
279 memcpy ((void *)ptr, (void *)(ptr - 16), 16);
280 ptr += 16;
281 }
282
283 for (; i < 64; i++) {
284 memcpy ((void *)(ptr + 16), (void *)ptr, 16);
285 ptr += 16;
286 }
287
288
289 writeByte (LCD_CURSOR_CNTL, 1);
290}
291#endif
292