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