3 * Stäubli Faverges - <www.staubli.com>
4 * Pierre AUBERT p.aubert@staubli.com
6 * SPDX-License-Identifier: GPL-2.0+
8 /* Video support for Epson SED13806 chipset */
15 #define readByte(ptrReg) \
16 *(volatile unsigned char *)(sed13806.isaBase + ptrReg)
18 #define writeByte(ptrReg,value) \
19 *(volatile unsigned char *)(sed13806.isaBase + ptrReg) = value
21 #ifdef CONFIG_TOTAL5200
22 #define writeWord(ptrReg,value) \
23 (*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = value)
25 #define writeWord(ptrReg,value) \
26 (*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = ((value >> 8 ) & 0xff) | ((value << 8) & 0xff00))
29 GraphicDevice sed13806;
31 /*-----------------------------------------------------------------------------
33 *-----------------------------------------------------------------------------
35 static void EpsonSetRegs (void)
37 /* the content of the chipset register depends on the board (clocks, ...)*/
38 const S1D_REGS *preg = board_get_regs ();
39 while (preg -> Index) {
40 writeByte (preg -> Index, preg -> Value);
45 /*-----------------------------------------------------------------------------
47 *-----------------------------------------------------------------------------
49 void *video_hw_init (void)
53 memset (&sed13806, 0, sizeof (GraphicDevice));
55 /* Initialization of the access to the graphic chipset
56 Retreive base address of the chipset
57 (see board/RPXClassic/eccx.c) */
58 if ((sed13806.isaBase = board_video_init ()) == 0) {
62 sed13806.frameAdrs = sed13806.isaBase + FRAME_BUFFER_OFFSET;
63 sed13806.winSizeX = board_get_width ();
64 sed13806.winSizeY = board_get_height ();
66 #if defined(CONFIG_VIDEO_SED13806_8BPP)
67 sed13806.gdfIndex = GDF__8BIT_INDEX;
68 sed13806.gdfBytesPP = 1;
70 #elif defined(CONFIG_VIDEO_SED13806_16BPP)
71 sed13806.gdfIndex = GDF_16BIT_565RGB;
72 sed13806.gdfBytesPP = 2;
75 #error Unsupported SED13806 BPP
78 sed13806.memSize = sed13806.winSizeX * sed13806.winSizeY * sed13806.gdfBytesPP;
80 /* Load SED registers */
83 /* (see board/RPXClassic/RPXClassic.c) */
84 board_validate_screen (sed13806.isaBase);
86 /* Clear video memory */
87 i = sed13806.memSize/4;
88 vm = (unsigned int *)sed13806.frameAdrs;
95 /*-----------------------------------------------------------------------------
96 * Epson_wait_idle -- Wait for hardware to become idle
97 *-----------------------------------------------------------------------------
99 static void Epson_wait_idle (void)
101 while (readByte (BLT_CTRL0) & 0x80);
103 /* Read a word in the BitBLT memory area to shutdown the BitBLT engine */
104 *(volatile unsigned short *)(sed13806.isaBase + BLT_REG);
107 /*-----------------------------------------------------------------------------
109 *-----------------------------------------------------------------------------
111 void video_hw_bitblt (
112 unsigned int bpp, /* bytes per pixel */
113 unsigned int src_x, /* source pos x */
114 unsigned int src_y, /* source pos y */
115 unsigned int dst_x, /* dest pos x */
116 unsigned int dst_y, /* dest pos y */
117 unsigned int dim_x, /* frame width */
118 unsigned int dim_y /* frame height */
121 register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
122 unsigned long srcAddr, dstAddr;
123 unsigned int stride = bpp * pGD -> winSizeX;
125 srcAddr = (src_y * stride) + (src_x * bpp);
126 dstAddr = (dst_y * stride) + (dst_x * bpp);
130 writeByte(BLT_ROP,0x0C); /* source */
131 writeByte(BLT_OP,0x02);/* move blit in positive direction with ROP */
132 writeWord(BLT_MEM_OFF0, stride / 2);
133 if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
134 writeByte(BLT_CTRL1,0x00);
137 writeByte(BLT_CTRL1,0x01);
140 writeWord(BLT_WIDTH0,(dim_x - 1));
141 writeWord(BLT_HEIGHT0,(dim_y - 1));
143 /* set up blit registers */
144 writeByte(BLT_SRC_ADDR0,srcAddr);
145 writeByte(BLT_SRC_ADDR1,srcAddr>>8);
146 writeByte(BLT_SRC_ADDR2,srcAddr>>16);
148 writeByte(BLT_DST_ADDR0,dstAddr);
149 writeByte(BLT_DST_ADDR1,dstAddr>>8);
150 writeByte(BLT_DST_ADDR2,dstAddr>>16);
152 /* Engage the blt engine */
153 /* rectangular region for src and dst */
154 writeByte(BLT_CTRL0,0x80);
156 /* wait untill current blits finished */
159 /*-----------------------------------------------------------------------------
160 * video_hw_rectfill --
161 *-----------------------------------------------------------------------------
163 void video_hw_rectfill (
164 unsigned int bpp, /* bytes per pixel */
165 unsigned int dst_x, /* dest pos x */
166 unsigned int dst_y, /* dest pos y */
167 unsigned int dim_x, /* frame width */
168 unsigned int dim_y, /* frame height */
169 unsigned int color /* fill color */
172 register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
173 unsigned long dstAddr;
174 unsigned int stride = bpp * pGD -> winSizeX;
176 dstAddr = (dst_y * stride) + (dst_x * bpp);
180 /* set up blit registers */
181 writeByte(BLT_DST_ADDR0,dstAddr);
182 writeByte(BLT_DST_ADDR1,dstAddr>>8);
183 writeByte(BLT_DST_ADDR2,dstAddr>>16);
185 writeWord(BLT_WIDTH0,(dim_x - 1));
186 writeWord(BLT_HEIGHT0,(dim_y - 1));
187 writeWord(BLT_FGCOLOR0,color);
189 writeByte(BLT_OP,0x0C); /* solid fill */
190 writeWord(BLT_MEM_OFF0,stride / 2);
192 if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
193 writeByte(BLT_CTRL1,0x00);
196 writeByte(BLT_CTRL1,0x01);
199 /* Engage the blt engine */
200 /* rectangular region for src and dst */
201 writeByte(BLT_CTRL0,0x80);
203 /* wait untill current blits finished */
207 /*-----------------------------------------------------------------------------
209 *-----------------------------------------------------------------------------
212 unsigned int index, /* color number */
213 unsigned char r, /* red */
214 unsigned char g, /* green */
215 unsigned char b /* blue */
218 writeByte(REG_LUT_ADDR, index );
219 writeByte(REG_LUT_DATA, r);
220 writeByte(REG_LUT_DATA, g);
221 writeByte(REG_LUT_DATA, b);
223 #ifdef CONFIG_VIDEO_HW_CURSOR
224 /*-----------------------------------------------------------------------------
225 * video_set_hw_cursor --
226 *-----------------------------------------------------------------------------
228 void video_set_hw_cursor (int x, int y)
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));
236 /*-----------------------------------------------------------------------------
237 * video_init_hw_cursor --
238 *-----------------------------------------------------------------------------
240 void video_init_hw_cursor (int font_width, int font_height)
242 volatile unsigned char *ptr;
243 unsigned char pattern;
247 /* Init cursor content
248 Cursor size is 64x64 pixels
249 Start of the cursor memory depends on panel type (dual panel ...) */
250 if ((i = readByte (LCD_CURSOR_START)) == 0) {
251 ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - HWCURSORSIZE);
254 ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - (i * 8192));
257 /* Fill the first line and the first empty line after cursor */
258 for (i = 0, pattern = 0; i < 64; i++) {
259 if (i < font_width) {
260 /* Invert background */
270 *(ptr + font_height * 16) = 0xaa;
277 /* Duplicate this line */
278 for (i = 1; i < font_height; i++) {
279 memcpy ((void *)ptr, (void *)(ptr - 16), 16);
283 for (; i < 64; i++) {
284 memcpy ((void *)(ptr + 16), (void *)ptr, 16);
288 /* Select cursor mode */
289 writeByte (LCD_CURSOR_CNTL, 1);