1dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#ifndef _FB_DRAW_H 2dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#define _FB_DRAW_H 3dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas 4dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#include <asm/types.h> 5779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#include <linux/fb.h> 6dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas 7dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas /* 8dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas * Compose two values, using a bitmask as decision value 9dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas * This is equivalent to (a & mask) | (b & ~mask) 10dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas */ 11dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas 12dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplasstatic inline unsigned long 13dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplascomp(unsigned long a, unsigned long b, unsigned long mask) 14dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas{ 15dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return ((a ^ b) & mask) ^ b; 16dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas} 17dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas 18dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas /* 19dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas * Create a pattern with the given pixel's color 20dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas */ 21dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas 22dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#if BITS_PER_LONG == 64 23dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplasstatic inline unsigned long 24dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplaspixel_to_pat( u32 bpp, u32 pixel) 25dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas{ 26dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas switch (bpp) { 27dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 1: 28dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0xfffffffffffffffful*pixel; 29dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 2: 30dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x5555555555555555ul*pixel; 31dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 4: 32dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x1111111111111111ul*pixel; 33dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 8: 34dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x0101010101010101ul*pixel; 35dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 12: 36bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski return 0x1001001001001001ul*pixel; 37dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 16: 38dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x0001000100010001ul*pixel; 39dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 24: 40bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski return 0x0001000001000001ul*pixel; 41dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 32: 42dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x0000000100000001ul*pixel; 43dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas default: 44dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas panic("pixel_to_pat(): unsupported pixelformat\n"); 45dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas } 46dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas} 47dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#else 48dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplasstatic inline unsigned long 49dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplaspixel_to_pat( u32 bpp, u32 pixel) 50dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas{ 51dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas switch (bpp) { 52dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 1: 53dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0xfffffffful*pixel; 54dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 2: 55dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x55555555ul*pixel; 56dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 4: 57dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x11111111ul*pixel; 58dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 8: 59dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x01010101ul*pixel; 60dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 12: 61bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski return 0x01001001ul*pixel; 62dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 16: 63dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x00010001ul*pixel; 64dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 24: 65bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski return 0x01000001ul*pixel; 66dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas case 32: 67dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas return 0x00000001ul*pixel; 68dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas default: 69dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas panic("pixel_to_pat(): unsupported pixelformat\n"); 70dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas } 71dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas} 72dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#endif 73779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 74779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#ifdef CONFIG_FB_CFB_REV_PIXELS_IN_BYTE 7515afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#if BITS_PER_LONG == 64 7615afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK1 0x5555555555555555ul 7715afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK2 0x3333333333333333ul 7815afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK4 0x0f0f0f0f0f0f0f0ful 7915afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#else 8015afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK1 0x55555555ul 8115afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK2 0x33333333ul 8215afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#define REV_PIXELS_MASK4 0x0f0f0f0ful 8315afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa#endif 8415afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa 8515afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisastatic inline unsigned long fb_rev_pixels_in_long(unsigned long val, 8615afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa u32 bswapmask) 8715afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa{ 8815afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa if (bswapmask & 1) 8915afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa val = comp(val >> 1, val << 1, REV_PIXELS_MASK1); 9015afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa if (bswapmask & 2) 9115afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa val = comp(val >> 2, val << 2, REV_PIXELS_MASK2); 9215afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa if (bswapmask & 3) 9315afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa val = comp(val >> 4, val << 4, REV_PIXELS_MASK4); 9455850f47333c6e7d932e6426eaed863b27c9cd7fAnton Vorontsov return val; 9515afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa} 96779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 97e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsovstatic inline u32 fb_shifted_pixels_mask_u32(struct fb_info *p, u32 index, 98e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov u32 bswapmask) 99779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa{ 100779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa u32 mask; 101779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 102779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa if (!bswapmask) { 103e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_HIGH(p, ~(u32)0, index); 104779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa } else { 105e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = 0xff << FB_LEFT_POS(p, 8); 106e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask; 107e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask)); 108779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#if defined(__i386__) || defined(__x86_64__) 109779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa /* Shift argument is limited to 0 - 31 on x86 based CPU's */ 110779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa if(index + bswapmask < 32) 111779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#endif 112e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask |= FB_SHIFT_HIGH(p, ~(u32)0, 113779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa (index + bswapmask) & ~(bswapmask)); 114779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa } 115779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa return mask; 116779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa} 117779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 118e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsovstatic inline unsigned long fb_shifted_pixels_mask_long(struct fb_info *p, 119e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov u32 index, 120e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov u32 bswapmask) 121779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa{ 122779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa unsigned long mask; 123779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 124779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa if (!bswapmask) { 125e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_HIGH(p, ~0UL, index); 126779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa } else { 127e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = 0xff << FB_LEFT_POS(p, 8); 128e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask; 129e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask)); 130779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#if defined(__i386__) || defined(__x86_64__) 131779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa /* Shift argument is limited to 0 - 31 on x86 based CPU's */ 132779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa if(index + bswapmask < BITS_PER_LONG) 133779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#endif 134e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov mask |= FB_SHIFT_HIGH(p, ~0UL, 135779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa (index + bswapmask) & ~(bswapmask)); 136779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa } 137779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa return mask; 138779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa} 139779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 140779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 141779121e9f17525769c04a00475fd85600c8c04ebPavel Pisastatic inline u32 fb_compute_bswapmask(struct fb_info *info) 142779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa{ 143779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa u32 bswapmask = 0; 144779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa unsigned bpp = info->var.bits_per_pixel; 145779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 146779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa if ((bpp < 8) && (info->var.nonstd & FB_NONSTD_REV_PIX_IN_B)) { 147779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa /* 148779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa * Reversed order of pixel layout in bytes 149779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa * works only for 1, 2 and 4 bpp 150779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa */ 151779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa bswapmask = 7 - bpp + 1; 152779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa } 153779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa return bswapmask; 154779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa} 155779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 156779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#else /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */ 157779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 15815afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisastatic inline unsigned long fb_rev_pixels_in_long(unsigned long val, 15915afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa u32 bswapmask) 16015afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa{ 16115afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa return val; 16215afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa} 16315afdd433610c4ba0edf1f8a59915b3755af7365Pavel Pisa 164e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov#define fb_shifted_pixels_mask_u32(p, i, b) FB_SHIFT_HIGH((p), ~(u32)0, (i)) 165e4c690e061b909127ab0f12e929f82f3f39ec953Anton Vorontsov#define fb_shifted_pixels_mask_long(p, i, b) FB_SHIFT_HIGH((p), ~0UL, (i)) 166779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#define fb_compute_bswapmask(...) 0 167779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 168779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa#endif /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */ 169779121e9f17525769c04a00475fd85600c8c04ebPavel Pisa 170bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define cpu_to_le_long _cpu_to_le_long(BITS_PER_LONG) 171bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define _cpu_to_le_long(x) __cpu_to_le_long(x) 172bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define __cpu_to_le_long(x) cpu_to_le##x 173bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski 174bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define le_long_to_cpu _le_long_to_cpu(BITS_PER_LONG) 175bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define _le_long_to_cpu(x) __le_long_to_cpu(x) 176bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski#define __le_long_to_cpu(x) le##x##_to_cpu 177bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski 178bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewskistatic inline unsigned long rolx(unsigned long word, unsigned int shift, unsigned int x) 179bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski{ 180bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski return (word << shift) | (word >> (x - shift)); 181bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski} 182bdca0f9b1eabb24373e2307fe492f428f5928abcMichal Januszewski 183dc0e6e0544f1cb2af44e5d7a7e68acda05dec6faAntonino A. Daplas#endif /* FB_DRAW_H */ 184