[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / video / fb_draw.h

#ifndef _FB_DRAW_H
#define _FB_DRAW_H

#include <asm/types.h>
#include <linux/fb.h>
#include <linux/bug.h>

    /*
     *  Compose two values, using a bitmask as decision value
     *  This is equivalent to (a & mask) | (b & ~mask)
     */

static inline unsigned long
comp(unsigned long a, unsigned long b, unsigned long mask)
{
    return ((a ^ b) & mask) ^ b;
}

    /*
     *  Create a pattern with the given pixel's color
     */

#if BITS_PER_LONG == 64
static inline unsigned long
pixel_to_pat( u32 bpp, u32 pixel)
{
	switch (bpp) {
	case 1:
		return 0xfffffffffffffffful*pixel;
	case 2:
		return 0x5555555555555555ul*pixel;
	case 4:
		return 0x1111111111111111ul*pixel;
	case 8:
		return 0x0101010101010101ul*pixel;
	case 12:
		return 0x1001001001001001ul*pixel;
	case 16:
		return 0x0001000100010001ul*pixel;
	case 24:
		return 0x0001000001000001ul*pixel;
	case 32:
		return 0x0000000100000001ul*pixel;
	default:
		WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp);
		return 0;
    }
}
#else
static inline unsigned long
pixel_to_pat( u32 bpp, u32 pixel)
{
	switch (bpp) {
	case 1:
		return 0xfffffffful*pixel;
	case 2:
		return 0x55555555ul*pixel;
	case 4:
		return 0x11111111ul*pixel;
	case 8:
		return 0x01010101ul*pixel;
	case 12:
		return 0x01001001ul*pixel;
	case 16:
		return 0x00010001ul*pixel;
	case 24:
		return 0x01000001ul*pixel;
	case 32:
		return 0x00000001ul*pixel;
	default:
		WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp);
		return 0;
    }
}
#endif

#ifdef CONFIG_FB_CFB_REV_PIXELS_IN_BYTE
#if BITS_PER_LONG == 64
#define REV_PIXELS_MASK1 0x5555555555555555ul
#define REV_PIXELS_MASK2 0x3333333333333333ul
#define REV_PIXELS_MASK4 0x0f0f0f0f0f0f0f0ful
#else
#define REV_PIXELS_MASK1 0x55555555ul
#define REV_PIXELS_MASK2 0x33333333ul
#define REV_PIXELS_MASK4 0x0f0f0f0ful
#endif

static inline unsigned long fb_rev_pixels_in_long(unsigned long val,
						  u32 bswapmask)
{
	if (bswapmask & 1)
		val = comp(val >> 1, val << 1, REV_PIXELS_MASK1);
	if (bswapmask & 2)
		val = comp(val >> 2, val << 2, REV_PIXELS_MASK2);
	if (bswapmask & 3)
		val = comp(val >> 4, val << 4, REV_PIXELS_MASK4);
	return val;
}

static inline u32 fb_shifted_pixels_mask_u32(struct fb_info *p, u32 index,
					     u32 bswapmask)
{
	u32 mask;

	if (!bswapmask) {
		mask = FB_SHIFT_HIGH(p, ~(u32)0, index);
	} else {
		mask = 0xff << FB_LEFT_POS(p, 8);
		mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask;
		mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask));
#if defined(__i386__) || defined(__x86_64__)
		/* Shift argument is limited to 0 - 31 on x86 based CPU's */
		if(index + bswapmask < 32)
#endif
			mask |= FB_SHIFT_HIGH(p, ~(u32)0,
					(index + bswapmask) & ~(bswapmask));
	}
	return mask;
}

static inline unsigned long fb_shifted_pixels_mask_long(struct fb_info *p,
							u32 index,
							u32 bswapmask)
{
	unsigned long mask;

	if (!bswapmask) {
		mask = FB_SHIFT_HIGH(p, ~0UL, index);
	} else {
		mask = 0xff << FB_LEFT_POS(p, 8);
		mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask;
		mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask));
#if defined(__i386__) || defined(__x86_64__)
		/* Shift argument is limited to 0 - 31 on x86 based CPU's */
		if(index + bswapmask < BITS_PER_LONG)
#endif
			mask |= FB_SHIFT_HIGH(p, ~0UL,
					(index + bswapmask) & ~(bswapmask));
	}
	return mask;
}


static inline u32 fb_compute_bswapmask(struct fb_info *info)
{
	u32 bswapmask = 0;
	unsigned bpp = info->var.bits_per_pixel;

	if ((bpp < 8) && (info->var.nonstd & FB_NONSTD_REV_PIX_IN_B)) {
		/*
		 * Reversed order of pixel layout in bytes
		 * works only for 1, 2 and 4 bpp
		 */
		bswapmask = 7 - bpp + 1;
	}
	return bswapmask;
}

#else /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */

static inline unsigned long fb_rev_pixels_in_long(unsigned long val,
						  u32 bswapmask)
{
	return val;
}

#define fb_shifted_pixels_mask_u32(p, i, b) FB_SHIFT_HIGH((p), ~(u32)0, (i))
#define fb_shifted_pixels_mask_long(p, i, b) FB_SHIFT_HIGH((p), ~0UL, (i))
#define fb_compute_bswapmask(...) 0

#endif  /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */

#define cpu_to_le_long _cpu_to_le_long(BITS_PER_LONG)
#define _cpu_to_le_long(x) __cpu_to_le_long(x)
#define __cpu_to_le_long(x) cpu_to_le##x

#define le_long_to_cpu _le_long_to_cpu(BITS_PER_LONG)
#define _le_long_to_cpu(x) __le_long_to_cpu(x)
#define __le_long_to_cpu(x) le##x##_to_cpu

static inline unsigned long rolx(unsigned long word, unsigned int shift, unsigned int x)
{
	return (word << shift) | (word >> (x - shift));
}

#endif /* FB_DRAW_H */
Commit	Line	Data
dc0e6e05 AD	1	#ifndef _FB_DRAW_H
	2	#define _FB_DRAW_H
	3
	4	#include <asm/types.h>
779121e9	5	#include <linux/fb.h>
3f6a5580	6	#include <linux/bug.h>
dc0e6e05 AD	7
	8	/*
	9	* Compose two values, using a bitmask as decision value
	10	* This is equivalent to (a & mask) \| (b & ~mask)
	11	*/
	12
	13	static inline unsigned long
	14	comp(unsigned long a, unsigned long b, unsigned long mask)
	15	{
	16	return ((a ^ b) & mask) ^ b;
	17	}
	18
	19	/*
	20	* Create a pattern with the given pixel's color
	21	*/
	22
	23	#if BITS_PER_LONG == 64
	24	static inline unsigned long
	25	pixel_to_pat( u32 bpp, u32 pixel)
	26	{
	27	switch (bpp) {
	28	case 1:
	29	return 0xfffffffffffffffful*pixel;
	30	case 2:
	31	return 0x5555555555555555ul*pixel;
	32	case 4:
	33	return 0x1111111111111111ul*pixel;
	34	case 8:
	35	return 0x0101010101010101ul*pixel;
	36	case 12:
bdca0f9b	37	return 0x1001001001001001ul*pixel;
dc0e6e05 AD	38	case 16:
	39	return 0x0001000100010001ul*pixel;
	40	case 24:
bdca0f9b	41	return 0x0001000001000001ul*pixel;
dc0e6e05 AD	42	case 32:
	43	return 0x0000000100000001ul*pixel;
	44	default:
3f6a5580 BH	45	WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp);
3f6a5580 BH	46	return 0;
dc0e6e05 AD	47	}
	48	}
	49	#else
	50	static inline unsigned long
	51	pixel_to_pat( u32 bpp, u32 pixel)
	52	{
	53	switch (bpp) {
	54	case 1:
	55	return 0xfffffffful*pixel;
	56	case 2:
	57	return 0x55555555ul*pixel;
	58	case 4:
	59	return 0x11111111ul*pixel;
	60	case 8:
	61	return 0x01010101ul*pixel;
	62	case 12:
bdca0f9b	63	return 0x01001001ul*pixel;
dc0e6e05 AD	64	case 16:
	65	return 0x00010001ul*pixel;
	66	case 24:
bdca0f9b	67	return 0x01000001ul*pixel;
dc0e6e05 AD	68	case 32:
	69	return 0x00000001ul*pixel;
	70	default:
3f6a5580 BH	71	WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp);
3f6a5580 BH	72	return 0;
dc0e6e05 AD	73	}
	74	}
	75	#endif
779121e9 PP	76
779121e9 PP	77	#ifdef CONFIG_FB_CFB_REV_PIXELS_IN_BYTE
15afdd43 PP	78	#if BITS_PER_LONG == 64
	79	#define REV_PIXELS_MASK1 0x5555555555555555ul
	80	#define REV_PIXELS_MASK2 0x3333333333333333ul
	81	#define REV_PIXELS_MASK4 0x0f0f0f0f0f0f0f0ful
	82	#else
	83	#define REV_PIXELS_MASK1 0x55555555ul
	84	#define REV_PIXELS_MASK2 0x33333333ul
	85	#define REV_PIXELS_MASK4 0x0f0f0f0ful
	86	#endif
	87
	88	static inline unsigned long fb_rev_pixels_in_long(unsigned long val,
	89	u32 bswapmask)
	90	{
	91	if (bswapmask & 1)
	92	val = comp(val >> 1, val << 1, REV_PIXELS_MASK1);
	93	if (bswapmask & 2)
	94	val = comp(val >> 2, val << 2, REV_PIXELS_MASK2);
	95	if (bswapmask & 3)
	96	val = comp(val >> 4, val << 4, REV_PIXELS_MASK4);
55850f47	97	return val;
15afdd43	98	}
779121e9	99
e4c690e0 AV	100	static inline u32 fb_shifted_pixels_mask_u32(struct fb_info *p, u32 index,
e4c690e0 AV	101	u32 bswapmask)
779121e9 PP	102	{
	103	u32 mask;
	104
	105	if (!bswapmask) {
e4c690e0	106	mask = FB_SHIFT_HIGH(p, ~(u32)0, index);
779121e9	107	} else {
e4c690e0 AV	108	mask = 0xff << FB_LEFT_POS(p, 8);
	109	mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask;
	110	mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask));
779121e9 PP	111	#if defined(__i386__) \|\| defined(__x86_64__)
	112	/* Shift argument is limited to 0 - 31 on x86 based CPU's */
	113	if(index + bswapmask < 32)
	114	#endif
e4c690e0	115	mask \|= FB_SHIFT_HIGH(p, ~(u32)0,
779121e9 PP	116	(index + bswapmask) & ~(bswapmask));
	117	}
	118	return mask;
	119	}
	120
e4c690e0 AV	121	static inline unsigned long fb_shifted_pixels_mask_long(struct fb_info *p,
	122	u32 index,
	123	u32 bswapmask)
779121e9 PP	124	{
	125	unsigned long mask;
	126
	127	if (!bswapmask) {
e4c690e0	128	mask = FB_SHIFT_HIGH(p, ~0UL, index);
779121e9	129	} else {
e4c690e0 AV	130	mask = 0xff << FB_LEFT_POS(p, 8);
	131	mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask;
	132	mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask));
779121e9 PP	133	#if defined(__i386__) \|\| defined(__x86_64__)
	134	/* Shift argument is limited to 0 - 31 on x86 based CPU's */
	135	if(index + bswapmask < BITS_PER_LONG)
	136	#endif
e4c690e0	137	mask \|= FB_SHIFT_HIGH(p, ~0UL,
779121e9 PP	138	(index + bswapmask) & ~(bswapmask));
	139	}
	140	return mask;
	141	}
	142
	143
	144	static inline u32 fb_compute_bswapmask(struct fb_info *info)
	145	{
	146	u32 bswapmask = 0;
	147	unsigned bpp = info->var.bits_per_pixel;
	148
	149	if ((bpp < 8) && (info->var.nonstd & FB_NONSTD_REV_PIX_IN_B)) {
	150	/*
	151	* Reversed order of pixel layout in bytes
	152	* works only for 1, 2 and 4 bpp
	153	*/
	154	bswapmask = 7 - bpp + 1;
	155	}
	156	return bswapmask;
	157	}
	158
	159	#else /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */
	160
15afdd43 PP	161	static inline unsigned long fb_rev_pixels_in_long(unsigned long val,
	162	u32 bswapmask)
	163	{
	164	return val;
	165	}
	166
e4c690e0 AV	167	#define fb_shifted_pixels_mask_u32(p, i, b) FB_SHIFT_HIGH((p), ~(u32)0, (i))
e4c690e0 AV	168	#define fb_shifted_pixels_mask_long(p, i, b) FB_SHIFT_HIGH((p), ~0UL, (i))
779121e9 PP	169	#define fb_compute_bswapmask(...) 0
	170
	171	#endif /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */
	172
bdca0f9b MJ	173	#define cpu_to_le_long _cpu_to_le_long(BITS_PER_LONG)
	174	#define _cpu_to_le_long(x) __cpu_to_le_long(x)
	175	#define __cpu_to_le_long(x) cpu_to_le##x
	176
	177	#define le_long_to_cpu _le_long_to_cpu(BITS_PER_LONG)
	178	#define _le_long_to_cpu(x) __le_long_to_cpu(x)
	179	#define __le_long_to_cpu(x) le##x##_to_cpu
	180
	181	static inline unsigned long rolx(unsigned long word, unsigned int shift, unsigned int x)
	182	{
	183	return (word << shift) \| (word >> (x - shift));
	184	}
	185
dc0e6e05	186	#endif /* FB_DRAW_H */