119757fc8STomi Valkeinen #ifndef _FB_DRAW_H 219757fc8STomi Valkeinen #define _FB_DRAW_H 319757fc8STomi Valkeinen 419757fc8STomi Valkeinen #include <asm/types.h> 519757fc8STomi Valkeinen #include <linux/fb.h> 619757fc8STomi Valkeinen #include <linux/bug.h> 719757fc8STomi Valkeinen 819757fc8STomi Valkeinen /* 919757fc8STomi Valkeinen * Compose two values, using a bitmask as decision value 1019757fc8STomi Valkeinen * This is equivalent to (a & mask) | (b & ~mask) 1119757fc8STomi Valkeinen */ 1219757fc8STomi Valkeinen 1319757fc8STomi Valkeinen static inline unsigned long 1419757fc8STomi Valkeinen comp(unsigned long a, unsigned long b, unsigned long mask) 1519757fc8STomi Valkeinen { 1619757fc8STomi Valkeinen return ((a ^ b) & mask) ^ b; 1719757fc8STomi Valkeinen } 1819757fc8STomi Valkeinen 1919757fc8STomi Valkeinen /* 2019757fc8STomi Valkeinen * Create a pattern with the given pixel's color 2119757fc8STomi Valkeinen */ 2219757fc8STomi Valkeinen 2319757fc8STomi Valkeinen #if BITS_PER_LONG == 64 2419757fc8STomi Valkeinen static inline unsigned long 2519757fc8STomi Valkeinen pixel_to_pat( u32 bpp, u32 pixel) 2619757fc8STomi Valkeinen { 2719757fc8STomi Valkeinen switch (bpp) { 2819757fc8STomi Valkeinen case 1: 2919757fc8STomi Valkeinen return 0xfffffffffffffffful*pixel; 3019757fc8STomi Valkeinen case 2: 3119757fc8STomi Valkeinen return 0x5555555555555555ul*pixel; 3219757fc8STomi Valkeinen case 4: 3319757fc8STomi Valkeinen return 0x1111111111111111ul*pixel; 3419757fc8STomi Valkeinen case 8: 3519757fc8STomi Valkeinen return 0x0101010101010101ul*pixel; 3619757fc8STomi Valkeinen case 12: 3719757fc8STomi Valkeinen return 0x1001001001001001ul*pixel; 3819757fc8STomi Valkeinen case 16: 3919757fc8STomi Valkeinen return 0x0001000100010001ul*pixel; 4019757fc8STomi Valkeinen case 24: 4119757fc8STomi Valkeinen return 0x0001000001000001ul*pixel; 4219757fc8STomi Valkeinen case 32: 4319757fc8STomi Valkeinen return 0x0000000100000001ul*pixel; 4419757fc8STomi Valkeinen default: 4519757fc8STomi Valkeinen WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp); 4619757fc8STomi Valkeinen return 0; 4719757fc8STomi Valkeinen } 4819757fc8STomi Valkeinen } 4919757fc8STomi Valkeinen #else 5019757fc8STomi Valkeinen static inline unsigned long 5119757fc8STomi Valkeinen pixel_to_pat( u32 bpp, u32 pixel) 5219757fc8STomi Valkeinen { 5319757fc8STomi Valkeinen switch (bpp) { 5419757fc8STomi Valkeinen case 1: 5519757fc8STomi Valkeinen return 0xfffffffful*pixel; 5619757fc8STomi Valkeinen case 2: 5719757fc8STomi Valkeinen return 0x55555555ul*pixel; 5819757fc8STomi Valkeinen case 4: 5919757fc8STomi Valkeinen return 0x11111111ul*pixel; 6019757fc8STomi Valkeinen case 8: 6119757fc8STomi Valkeinen return 0x01010101ul*pixel; 6219757fc8STomi Valkeinen case 12: 6319757fc8STomi Valkeinen return 0x01001001ul*pixel; 6419757fc8STomi Valkeinen case 16: 6519757fc8STomi Valkeinen return 0x00010001ul*pixel; 6619757fc8STomi Valkeinen case 24: 6719757fc8STomi Valkeinen return 0x01000001ul*pixel; 6819757fc8STomi Valkeinen case 32: 6919757fc8STomi Valkeinen return 0x00000001ul*pixel; 7019757fc8STomi Valkeinen default: 7119757fc8STomi Valkeinen WARN(1, "pixel_to_pat(): unsupported pixelformat %d\n", bpp); 7219757fc8STomi Valkeinen return 0; 7319757fc8STomi Valkeinen } 7419757fc8STomi Valkeinen } 7519757fc8STomi Valkeinen #endif 7619757fc8STomi Valkeinen 7719757fc8STomi Valkeinen #ifdef CONFIG_FB_CFB_REV_PIXELS_IN_BYTE 7819757fc8STomi Valkeinen #if BITS_PER_LONG == 64 7919757fc8STomi Valkeinen #define REV_PIXELS_MASK1 0x5555555555555555ul 8019757fc8STomi Valkeinen #define REV_PIXELS_MASK2 0x3333333333333333ul 8119757fc8STomi Valkeinen #define REV_PIXELS_MASK4 0x0f0f0f0f0f0f0f0ful 8219757fc8STomi Valkeinen #else 8319757fc8STomi Valkeinen #define REV_PIXELS_MASK1 0x55555555ul 8419757fc8STomi Valkeinen #define REV_PIXELS_MASK2 0x33333333ul 8519757fc8STomi Valkeinen #define REV_PIXELS_MASK4 0x0f0f0f0ful 8619757fc8STomi Valkeinen #endif 8719757fc8STomi Valkeinen 8819757fc8STomi Valkeinen static inline unsigned long fb_rev_pixels_in_long(unsigned long val, 8919757fc8STomi Valkeinen u32 bswapmask) 9019757fc8STomi Valkeinen { 9119757fc8STomi Valkeinen if (bswapmask & 1) 9219757fc8STomi Valkeinen val = comp(val >> 1, val << 1, REV_PIXELS_MASK1); 9319757fc8STomi Valkeinen if (bswapmask & 2) 9419757fc8STomi Valkeinen val = comp(val >> 2, val << 2, REV_PIXELS_MASK2); 9519757fc8STomi Valkeinen if (bswapmask & 3) 9619757fc8STomi Valkeinen val = comp(val >> 4, val << 4, REV_PIXELS_MASK4); 9719757fc8STomi Valkeinen return val; 9819757fc8STomi Valkeinen } 9919757fc8STomi Valkeinen 10019757fc8STomi Valkeinen static inline u32 fb_shifted_pixels_mask_u32(struct fb_info *p, u32 index, 10119757fc8STomi Valkeinen u32 bswapmask) 10219757fc8STomi Valkeinen { 10319757fc8STomi Valkeinen u32 mask; 10419757fc8STomi Valkeinen 10519757fc8STomi Valkeinen if (!bswapmask) { 10619757fc8STomi Valkeinen mask = FB_SHIFT_HIGH(p, ~(u32)0, index); 10719757fc8STomi Valkeinen } else { 10819757fc8STomi Valkeinen mask = 0xff << FB_LEFT_POS(p, 8); 10919757fc8STomi Valkeinen mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask; 11019757fc8STomi Valkeinen mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask)); 11119757fc8STomi Valkeinen #if defined(__i386__) || defined(__x86_64__) 11219757fc8STomi Valkeinen /* Shift argument is limited to 0 - 31 on x86 based CPU's */ 11319757fc8STomi Valkeinen if(index + bswapmask < 32) 11419757fc8STomi Valkeinen #endif 11519757fc8STomi Valkeinen mask |= FB_SHIFT_HIGH(p, ~(u32)0, 11619757fc8STomi Valkeinen (index + bswapmask) & ~(bswapmask)); 11719757fc8STomi Valkeinen } 11819757fc8STomi Valkeinen return mask; 11919757fc8STomi Valkeinen } 12019757fc8STomi Valkeinen 12119757fc8STomi Valkeinen static inline unsigned long fb_shifted_pixels_mask_long(struct fb_info *p, 12219757fc8STomi Valkeinen u32 index, 12319757fc8STomi Valkeinen u32 bswapmask) 12419757fc8STomi Valkeinen { 12519757fc8STomi Valkeinen unsigned long mask; 12619757fc8STomi Valkeinen 12719757fc8STomi Valkeinen if (!bswapmask) { 12819757fc8STomi Valkeinen mask = FB_SHIFT_HIGH(p, ~0UL, index); 12919757fc8STomi Valkeinen } else { 13019757fc8STomi Valkeinen mask = 0xff << FB_LEFT_POS(p, 8); 13119757fc8STomi Valkeinen mask = FB_SHIFT_LOW(p, mask, index & (bswapmask)) & mask; 13219757fc8STomi Valkeinen mask = FB_SHIFT_HIGH(p, mask, index & ~(bswapmask)); 13319757fc8STomi Valkeinen #if defined(__i386__) || defined(__x86_64__) 13419757fc8STomi Valkeinen /* Shift argument is limited to 0 - 31 on x86 based CPU's */ 13519757fc8STomi Valkeinen if(index + bswapmask < BITS_PER_LONG) 13619757fc8STomi Valkeinen #endif 13719757fc8STomi Valkeinen mask |= FB_SHIFT_HIGH(p, ~0UL, 13819757fc8STomi Valkeinen (index + bswapmask) & ~(bswapmask)); 13919757fc8STomi Valkeinen } 14019757fc8STomi Valkeinen return mask; 14119757fc8STomi Valkeinen } 14219757fc8STomi Valkeinen 14319757fc8STomi Valkeinen 14419757fc8STomi Valkeinen static inline u32 fb_compute_bswapmask(struct fb_info *info) 14519757fc8STomi Valkeinen { 14619757fc8STomi Valkeinen u32 bswapmask = 0; 14719757fc8STomi Valkeinen unsigned bpp = info->var.bits_per_pixel; 14819757fc8STomi Valkeinen 14919757fc8STomi Valkeinen if ((bpp < 8) && (info->var.nonstd & FB_NONSTD_REV_PIX_IN_B)) { 15019757fc8STomi Valkeinen /* 15119757fc8STomi Valkeinen * Reversed order of pixel layout in bytes 15219757fc8STomi Valkeinen * works only for 1, 2 and 4 bpp 15319757fc8STomi Valkeinen */ 15419757fc8STomi Valkeinen bswapmask = 7 - bpp + 1; 15519757fc8STomi Valkeinen } 15619757fc8STomi Valkeinen return bswapmask; 15719757fc8STomi Valkeinen } 15819757fc8STomi Valkeinen 15919757fc8STomi Valkeinen #else /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */ 16019757fc8STomi Valkeinen 16119757fc8STomi Valkeinen static inline unsigned long fb_rev_pixels_in_long(unsigned long val, 16219757fc8STomi Valkeinen u32 bswapmask) 16319757fc8STomi Valkeinen { 16419757fc8STomi Valkeinen return val; 16519757fc8STomi Valkeinen } 16619757fc8STomi Valkeinen 16719757fc8STomi Valkeinen #define fb_shifted_pixels_mask_u32(p, i, b) FB_SHIFT_HIGH((p), ~(u32)0, (i)) 16819757fc8STomi Valkeinen #define fb_shifted_pixels_mask_long(p, i, b) FB_SHIFT_HIGH((p), ~0UL, (i)) 16919757fc8STomi Valkeinen #define fb_compute_bswapmask(...) 0 17019757fc8STomi Valkeinen 17119757fc8STomi Valkeinen #endif /* CONFIG_FB_CFB_REV_PIXELS_IN_BYTE */ 17219757fc8STomi Valkeinen 17319757fc8STomi Valkeinen #define cpu_to_le_long _cpu_to_le_long(BITS_PER_LONG) 17419757fc8STomi Valkeinen #define _cpu_to_le_long(x) __cpu_to_le_long(x) 17519757fc8STomi Valkeinen #define __cpu_to_le_long(x) cpu_to_le##x 17619757fc8STomi Valkeinen 17719757fc8STomi Valkeinen #define le_long_to_cpu _le_long_to_cpu(BITS_PER_LONG) 17819757fc8STomi Valkeinen #define _le_long_to_cpu(x) __le_long_to_cpu(x) 17919757fc8STomi Valkeinen #define __le_long_to_cpu(x) le##x##_to_cpu 18019757fc8STomi Valkeinen 18119757fc8STomi Valkeinen static inline unsigned long rolx(unsigned long word, unsigned int shift, unsigned int x) 18219757fc8STomi Valkeinen { 18319757fc8STomi Valkeinen return (word << shift) | (word >> (x - shift)); 18419757fc8STomi Valkeinen } 18519757fc8STomi Valkeinen 18619757fc8STomi Valkeinen #endif /* FB_DRAW_H */ 187