Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2)  *  linux/drivers/video/iplan2p4.c -- Low level frame buffer operations for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *				      interleaved bitplanes à la Atari (4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *				      planes, 2 bytes interleave)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *	Created 5 Apr 1997 by Geert Uytterhoeven
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *  This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  *  License.  See the file COPYING in the main directory of this archive for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *  more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <asm/setup.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include "atafb.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define BPL	4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include "atafb_utils.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) void atafb_iplan2p4_copyarea(struct fb_info *info, u_long next_line,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 			     int sy, int sx, int dy, int dx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 			     int height, int width)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	/*  bmove() has to distinguish two major cases: If both, source and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	 *  destination, start at even addresses or both are at odd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	 *  addresses, just the first odd and last even column (if present)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	 *  require special treatment (memmove_col()). The rest between
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	 *  then can be copied by normal operations, because all adjacent
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	 *  bytes are affected and are to be stored in the same order.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	 *    The pathological case is when the move should go from an odd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	 *  address to an even or vice versa. Since the bytes in the plane
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	 *  words must be assembled in new order, it seems wisest to make
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	 *  all movements by memmove_col().
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	u8 *src, *dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	u32 *s, *d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	int w, l , i, j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	u_int colsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	u_int upwards = (dy < sy) || (dy == sy && dx < sx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	colsize = height;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	if (!((sx ^ dx) & 15)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 		/* odd->odd or even->even */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 		if (upwards) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 			src = (u8 *)info->screen_base + sy * next_line + (sx & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 			dst = (u8 *)info->screen_base + dy * next_line + (dx & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 			if (sx & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 				memmove32_col(dst, src, 0xff00ff, height, next_line - BPL * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 				src += BPL * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 				dst += BPL * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 				width -= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 			w = width >> 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 			if (w) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 				s = (u32 *)src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 				d = (u32 *)dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 				w *= BPL / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 				l = next_line - w * 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 				for (j = height; j > 0; j--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 					for (i = w; i > 0; i--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 						*d++ = *s++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 					s = (u32 *)((u8 *)s + l);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 					d = (u32 *)((u8 *)d + l);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 			if (width & 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 				memmove32_col(dst + width / (8 / BPL), src + width / (8 / BPL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 					      0xff00ff00, height, next_line - BPL * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 			src = (u8 *)info->screen_base + (sy - 1) * next_line + ((sx + width + 8) & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 			dst = (u8 *)info->screen_base + (dy - 1) * next_line + ((dx + width + 8) & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 			if ((sx + width) & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 				src -= BPL * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 				dst -= BPL * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 				memmove32_col(dst, src, 0xff00ff00, colsize, -next_line - BPL * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 				width -= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 			w = width >> 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 			if (w) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 				s = (u32 *)src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 				d = (u32 *)dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 				w *= BPL / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 				l = next_line - w * 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 				for (j = height; j > 0; j--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 					for (i = w; i > 0; i--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 						*--d = *--s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 					s = (u32 *)((u8 *)s - l);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 					d = (u32 *)((u8 *)d - l);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 			if (sx & 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 				memmove32_col(dst - (width - 16) / (8 / BPL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 					      src - (width - 16) / (8 / BPL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 					      0xff00ff, colsize, -next_line - BPL * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 		/* odd->even or even->odd */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		if (upwards) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 			u32 *src32, *dst32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 			u32 pval[4], v, v1, mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 			int i, j, w, f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 			src = (u8 *)info->screen_base + sy * next_line + (sx & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 			dst = (u8 *)info->screen_base + dy * next_line + (dx & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 			mask = 0xff00ff00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 			f = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 			w = width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 			if (sx & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 				f = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 				w += 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 			if ((sx + width) & 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 				f |= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 			w >>= 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 			for (i = height; i; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 				src32 = (u32 *)src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 				dst32 = (u32 *)dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 				if (f & 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 					pval[0] = (*src32++ << 8) & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 					pval[1] = (*src32++ << 8) & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 				} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 					pval[0] = dst32[0] & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 					pval[1] = dst32[1] & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 				for (j = w; j > 0; j--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 					v = *src32++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 					v1 = v & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 					*dst32++ = pval[0] | (v1 >> 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 					pval[0] = (v ^ v1) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 					v = *src32++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 					v1 = v & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 					*dst32++ = pval[1] | (v1 >> 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 					pval[1] = (v ^ v1) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 				if (f & 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 					dst32[0] = (dst32[0] & mask) | pval[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 					dst32[1] = (dst32[1] & mask) | pval[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 				src += next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 				dst += next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 			u32 *src32, *dst32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 			u32 pval[4], v, v1, mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 			int i, j, w, f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 			src = (u8 *)info->screen_base + (sy - 1) * next_line + ((sx + width + 8) & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 			dst = (u8 *)info->screen_base + (dy - 1) * next_line + ((dx + width + 8) & ~15) / (8 / BPL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 			mask = 0xff00ff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 			f = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 			w = width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 			if ((dx + width) & 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 				f = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 			if (sx & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 				f |= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 				w += 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 			w >>= 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 			for (i = height; i; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 				src32 = (u32 *)src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 				dst32 = (u32 *)dst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 				if (f & 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 					pval[0] = dst32[-1] & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 					pval[1] = dst32[-2] & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 				} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 					pval[0] = (*--src32 >> 8) & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 					pval[1] = (*--src32 >> 8) & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 				for (j = w; j > 0; j--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 					v = *--src32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 					v1 = v & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 					*--dst32 = pval[0] | (v1 << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 					pval[0] = (v ^ v1) >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 					v = *--src32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 					v1 = v & mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 					*--dst32 = pval[1] | (v1 << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 					pval[1] = (v ^ v1) >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 				if (!(f & 2)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 					dst32[-1] = (dst32[-1] & mask) | pval[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 					dst32[-2] = (dst32[-2] & mask) | pval[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 				}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 				src -= next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 				dst -= next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) void atafb_iplan2p4_fillrect(struct fb_info *info, u_long next_line, u32 color,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)                              int sy, int sx, int height, int width)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	u32 *dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	int rows, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	u32 cval[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	dest = (u32 *)(info->screen_base + sy * next_line + (sx & ~15) / (8 / BPL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	if (sx & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		u8 *dest8 = (u8 *)dest + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		expand8_col2mask(color, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 		for (i = height; i; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 			fill8_col(dest8, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			dest8 += next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		dest += BPL / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		width -= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	expand16_col2mask(color, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	rows = width >> 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	if (rows) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		u32 *d = dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 		u32 off = next_line - rows * BPL * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		for (i = height; i; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 			d = fill16_col(d, rows, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 			d = (u32 *)((long)d + off);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 		dest += rows * BPL / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 		width &= 15;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	if (width) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 		u8 *dest8 = (u8 *)dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		expand8_col2mask(color, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		for (i = height; i; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 			fill8_col(dest8, cval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 			dest8 += next_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) void atafb_iplan2p4_linefill(struct fb_info *info, u_long next_line,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)                              int dy, int dx, u32 width,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)                              const u8 *data, u32 bgcolor, u32 fgcolor)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	u32 *dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	const u16 *data16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	int rows;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	u32 fgm[4], bgm[4], m;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 	dest = (u32 *)(info->screen_base + dy * next_line + (dx & ~15) / (8 / BPL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	if (dx & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		fill8_2col((u8 *)dest + 1, fgcolor, bgcolor, *data++);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		dest += BPL / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 		width -= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	if (width >= 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		data16 = (const u16 *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 		expand16_2col2mask(fgcolor, bgcolor, fgm, bgm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 		for (rows = width / 16; rows; rows--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 			u16 d = *data16++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 			m = d | ((u32)d << 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 			*dest++ = (m & fgm[0]) ^ bgm[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 			*dest++ = (m & fgm[1]) ^ bgm[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		data = (const u8 *)data16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 		width &= 15;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	if (width)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 		fill8_2col((u8 *)dest, fgcolor, bgcolor, *data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) }