1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * drivers/mb862xx/mb862xxfb_accel.c
4  *
5  * Fujitsu Carmine/Coral-P(A)/Lime framebuffer driver acceleration support
6  *
7  * (C) 2007 Alexander Shishkin <virtuoso@slind.org>
8  * (C) 2009 Valentin Sitdikov <v.sitdikov@gmail.com>
9  * (C) 2009 Siemens AG
10  */
11 #include <linux/fb.h>
12 #include <linux/delay.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/module.h>
16 #include <linux/pci.h>
17 #include <linux/slab.h>
18 #if defined(CONFIG_OF)
19 #include <linux/of_platform.h>
20 #endif
21 #include "mb862xxfb.h"
22 #include "mb862xx_reg.h"
23 #include "mb862xxfb_accel.h"
24 
25 static void mb862xxfb_write_fifo(u32 count, u32 *data, struct fb_info *info)
26 {
27 	struct mb862xxfb_par *par = info->par;
28 	static u32 free;
29 
30 	u32 total = 0;
31 	while (total < count) {
32 		if (free) {
33 			outreg(geo, GDC_GEO_REG_INPUT_FIFO, data[total]);
34 			total++;
35 			free--;
36 		} else {
37 			free = (u32) inreg(draw, GDC_REG_FIFO_COUNT);
38 		}
39 	}
40 }
41 
42 static void mb86290fb_copyarea(struct fb_info *info,
43 			       const struct fb_copyarea *area)
44 {
45 	__u32 cmd[6];
46 
47 	cmd[0] = (GDC_TYPE_SETREGISTER << 24) | (1 << 16) | GDC_REG_MODE_BITMAP;
48 	/* Set raster operation */
49 	cmd[1] = (2 << 7) | (GDC_ROP_COPY << 9);
50 	cmd[2] = GDC_TYPE_BLTCOPYP << 24;
51 
52 	if (area->sx >= area->dx && area->sy >= area->dy)
53 		cmd[2] |= GDC_CMD_BLTCOPY_TOP_LEFT << 16;
54 	else if (area->sx >= area->dx && area->sy <= area->dy)
55 		cmd[2] |= GDC_CMD_BLTCOPY_BOTTOM_LEFT << 16;
56 	else if (area->sx <= area->dx && area->sy >= area->dy)
57 		cmd[2] |= GDC_CMD_BLTCOPY_TOP_RIGHT << 16;
58 	else
59 		cmd[2] |= GDC_CMD_BLTCOPY_BOTTOM_RIGHT << 16;
60 
61 	cmd[3] = (area->sy << 16) | area->sx;
62 	cmd[4] = (area->dy << 16) | area->dx;
63 	cmd[5] = (area->height << 16) | area->width;
64 	mb862xxfb_write_fifo(6, cmd, info);
65 }
66 
67 /*
68  * Fill in the cmd array /GDC FIFO commands/ to draw a 1bit image.
69  * Make sure cmd has enough room!
70  */
71 static void mb86290fb_imageblit1(u32 *cmd, u16 step, u16 dx, u16 dy,
72 				 u16 width, u16 height, u32 fgcolor,
73 				 u32 bgcolor, const struct fb_image *image,
74 				 struct fb_info *info)
75 {
76 	int i;
77 	unsigned const char *line;
78 	u16 bytes;
79 
80 	/* set colors and raster operation regs */
81 	cmd[0] = (GDC_TYPE_SETREGISTER << 24) | (1 << 16) | GDC_REG_MODE_BITMAP;
82 	/* Set raster operation */
83 	cmd[1] = (2 << 7) | (GDC_ROP_COPY << 9);
84 	cmd[2] =
85 	    (GDC_TYPE_SETCOLORREGISTER << 24) | (GDC_CMD_BODY_FORE_COLOR << 16);
86 	cmd[3] = fgcolor;
87 	cmd[4] =
88 	    (GDC_TYPE_SETCOLORREGISTER << 24) | (GDC_CMD_BODY_BACK_COLOR << 16);
89 	cmd[5] = bgcolor;
90 
91 	i = 0;
92 	line = image->data;
93 	bytes = (image->width + 7) >> 3;
94 
95 	/* and the image */
96 	cmd[6] = (GDC_TYPE_DRAWBITMAPP << 24) |
97 	    (GDC_CMD_BITMAP << 16) | (2 + (step * height));
98 	cmd[7] = (dy << 16) | dx;
99 	cmd[8] = (height << 16) | width;
100 
101 	while (i < height) {
102 		memcpy(&cmd[9 + i * step], line, step << 2);
103 #ifdef __LITTLE_ENDIAN
104 		{
105 			int k = 0;
106 			for (k = 0; k < step; k++)
107 				cmd[9 + i * step + k] =
108 				    cpu_to_be32(cmd[9 + i * step + k]);
109 		}
110 #endif
111 		line += bytes;
112 		i++;
113 	}
114 }
115 
116 /*
117  * Fill in the cmd array /GDC FIFO commands/ to draw a 8bit image.
118  * Make sure cmd has enough room!
119  */
120 static void mb86290fb_imageblit8(u32 *cmd, u16 step, u16 dx, u16 dy,
121 				 u16 width, u16 height, u32 fgcolor,
122 				 u32 bgcolor, const struct fb_image *image,
123 				 struct fb_info *info)
124 {
125 	int i, j;
126 	unsigned const char *line, *ptr;
127 	u16 bytes;
128 
129 	cmd[0] = (GDC_TYPE_DRAWBITMAPP << 24) |
130 	    (GDC_CMD_BLT_DRAW << 16) | (2 + (height * step));
131 	cmd[1] = (dy << 16) | dx;
132 	cmd[2] = (height << 16) | width;
133 
134 	i = 0;
135 	line = ptr = image->data;
136 	bytes = image->width;
137 
138 	while (i < height) {
139 		ptr = line;
140 		for (j = 0; j < step; j++) {
141 			cmd[3 + i * step + j] =
142 			    (((u32 *) (info->pseudo_palette))[*ptr]) & 0xffff;
143 			ptr++;
144 			cmd[3 + i * step + j] |=
145 			    ((((u32 *) (info->
146 					pseudo_palette))[*ptr]) & 0xffff) << 16;
147 			ptr++;
148 		}
149 
150 		line += bytes;
151 		i++;
152 	}
153 }
154 
155 /*
156  * Fill in the cmd array /GDC FIFO commands/ to draw a 16bit image.
157  * Make sure cmd has enough room!
158  */
159 static void mb86290fb_imageblit16(u32 *cmd, u16 step, u16 dx, u16 dy,
160 				  u16 width, u16 height, u32 fgcolor,
161 				  u32 bgcolor, const struct fb_image *image,
162 				  struct fb_info *info)
163 {
164 	int i;
165 	unsigned const char *line;
166 	u16 bytes;
167 
168 	i = 0;
169 	line = image->data;
170 	bytes = image->width << 1;
171 
172 	cmd[0] = (GDC_TYPE_DRAWBITMAPP << 24) |
173 	    (GDC_CMD_BLT_DRAW << 16) | (2 + step * height);
174 	cmd[1] = (dy << 16) | dx;
175 	cmd[2] = (height << 16) | width;
176 
177 	while (i < height) {
178 		memcpy(&cmd[3 + i * step], line, step);
179 		line += bytes;
180 		i++;
181 	}
182 }
183 
184 static void mb86290fb_imageblit(struct fb_info *info,
185 				const struct fb_image *image)
186 {
187 	int mdr;
188 	u32 *cmd = NULL;
189 	void (*cmdfn) (u32 *, u16, u16, u16, u16, u16, u32, u32,
190 		       const struct fb_image *, struct fb_info *) = NULL;
191 	u32 cmdlen;
192 	u32 fgcolor = 0, bgcolor = 0;
193 	u16 step;
194 
195 	u16 width = image->width, height = image->height;
196 	u16 dx = image->dx, dy = image->dy;
197 	int x2, y2, vxres, vyres;
198 
199 	mdr = (GDC_ROP_COPY << 9);
200 	x2 = image->dx + image->width;
201 	y2 = image->dy + image->height;
202 	vxres = info->var.xres_virtual;
203 	vyres = info->var.yres_virtual;
204 	x2 = min(x2, vxres);
205 	y2 = min(y2, vyres);
206 	width = x2 - dx;
207 	height = y2 - dy;
208 
209 	switch (image->depth) {
210 	case 1:
211 		step = (width + 31) >> 5;
212 		cmdlen = 9 + height * step;
213 		cmdfn = mb86290fb_imageblit1;
214 		if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
215 		    info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
216 			fgcolor =
217 			    ((u32 *) (info->pseudo_palette))[image->fg_color];
218 			bgcolor =
219 			    ((u32 *) (info->pseudo_palette))[image->bg_color];
220 		} else {
221 			fgcolor = image->fg_color;
222 			bgcolor = image->bg_color;
223 		}
224 
225 		break;
226 
227 	case 8:
228 		step = (width + 1) >> 1;
229 		cmdlen = 3 + height * step;
230 		cmdfn = mb86290fb_imageblit8;
231 		break;
232 
233 	case 16:
234 		step = (width + 1) >> 1;
235 		cmdlen = 3 + height * step;
236 		cmdfn = mb86290fb_imageblit16;
237 		break;
238 
239 	default:
240 		cfb_imageblit(info, image);
241 		return;
242 	}
243 
244 	cmd = kmalloc_array(cmdlen, 4, GFP_DMA);
245 	if (!cmd)
246 		return cfb_imageblit(info, image);
247 	cmdfn(cmd, step, dx, dy, width, height, fgcolor, bgcolor, image, info);
248 	mb862xxfb_write_fifo(cmdlen, cmd, info);
249 	kfree(cmd);
250 }
251 
252 static void mb86290fb_fillrect(struct fb_info *info,
253 			       const struct fb_fillrect *rect)
254 {
255 
256 	u32 x2, y2, vxres, vyres, height, width, fg;
257 	u32 cmd[7];
258 
259 	vxres = info->var.xres_virtual;
260 	vyres = info->var.yres_virtual;
261 
262 	if (!rect->width || !rect->height || rect->dx > vxres
263 	    || rect->dy > vyres)
264 		return;
265 
266 	/* We could use hardware clipping but on many cards you get around
267 	 * hardware clipping by writing to framebuffer directly. */
268 	x2 = rect->dx + rect->width;
269 	y2 = rect->dy + rect->height;
270 	x2 = min(x2, vxres);
271 	y2 = min(y2, vyres);
272 	width = x2 - rect->dx;
273 	height = y2 - rect->dy;
274 	if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
275 	    info->fix.visual == FB_VISUAL_DIRECTCOLOR)
276 		fg = ((u32 *) (info->pseudo_palette))[rect->color];
277 	else
278 		fg = rect->color;
279 
280 	switch (rect->rop) {
281 
282 	case ROP_XOR:
283 		/* Set raster operation */
284 		cmd[1] = (2 << 7) | (GDC_ROP_XOR << 9);
285 		break;
286 
287 	case ROP_COPY:
288 		/* Set raster operation */
289 		cmd[1] = (2 << 7) | (GDC_ROP_COPY << 9);
290 		break;
291 
292 	}
293 
294 	cmd[0] = (GDC_TYPE_SETREGISTER << 24) | (1 << 16) | GDC_REG_MODE_BITMAP;
295 	/* cmd[1] set earlier */
296 	cmd[2] =
297 	    (GDC_TYPE_SETCOLORREGISTER << 24) | (GDC_CMD_BODY_FORE_COLOR << 16);
298 	cmd[3] = fg;
299 	cmd[4] = (GDC_TYPE_DRAWRECTP << 24) | (GDC_CMD_BLT_FILL << 16);
300 	cmd[5] = (rect->dy << 16) | (rect->dx);
301 	cmd[6] = (height << 16) | width;
302 
303 	mb862xxfb_write_fifo(7, cmd, info);
304 }
305 
306 void mb862xxfb_init_accel(struct fb_info *info, int xres)
307 {
308 	struct mb862xxfb_par *par = info->par;
309 
310 	if (info->var.bits_per_pixel == 32) {
311 		info->fbops->fb_fillrect = cfb_fillrect;
312 		info->fbops->fb_copyarea = cfb_copyarea;
313 		info->fbops->fb_imageblit = cfb_imageblit;
314 	} else {
315 		outreg(disp, GC_L0EM, 3);
316 		info->fbops->fb_fillrect = mb86290fb_fillrect;
317 		info->fbops->fb_copyarea = mb86290fb_copyarea;
318 		info->fbops->fb_imageblit = mb86290fb_imageblit;
319 	}
320 	outreg(draw, GDC_REG_DRAW_BASE, 0);
321 	outreg(draw, GDC_REG_MODE_MISC, 0x8000);
322 	outreg(draw, GDC_REG_X_RESOLUTION, xres);
323 
324 	info->flags |=
325 	    FBINFO_HWACCEL_COPYAREA | FBINFO_HWACCEL_FILLRECT |
326 	    FBINFO_HWACCEL_IMAGEBLIT;
327 	info->fix.accel = 0xff;	/*FIXME: add right define */
328 }
329 EXPORT_SYMBOL(mb862xxfb_init_accel);
330 
331 MODULE_LICENSE("GPL v2");
332