2 * linux/drivers/video/fbcmap.c -- Colormap handling for frame buffer devices
4 * Created 15 Jun 1997 by Geert Uytterhoeven
6 * 2001 - Documented with DocBook
7 * - Brad Douglas <brad@neruo.com>
9 * This file is subject to the terms and conditions of the GNU General Public
10 * License. See the file COPYING in the main directory of this archive for
14 #include <linux/string.h>
15 #include <linux/module.h>
16 #include <linux/tty.h>
18 #include <linux/slab.h>
20 #include <asm/uaccess.h>
25 static u16 green2
[] = {
28 static u16 blue2
[] = {
33 0x0000, 0xaaaa, 0x5555, 0xffff
35 static u16 green4
[] = {
36 0x0000, 0xaaaa, 0x5555, 0xffff
38 static u16 blue4
[] = {
39 0x0000, 0xaaaa, 0x5555, 0xffff
43 0x0000, 0x0000, 0x0000, 0x0000, 0xaaaa, 0xaaaa, 0xaaaa, 0xaaaa
45 static u16 green8
[] = {
46 0x0000, 0x0000, 0xaaaa, 0xaaaa, 0x0000, 0x0000, 0x5555, 0xaaaa
48 static u16 blue8
[] = {
49 0x0000, 0xaaaa, 0x0000, 0xaaaa, 0x0000, 0xaaaa, 0x0000, 0xaaaa
52 static u16 red16
[] = {
53 0x0000, 0x0000, 0x0000, 0x0000, 0xaaaa, 0xaaaa, 0xaaaa, 0xaaaa,
54 0x5555, 0x5555, 0x5555, 0x5555, 0xffff, 0xffff, 0xffff, 0xffff
56 static u16 green16
[] = {
57 0x0000, 0x0000, 0xaaaa, 0xaaaa, 0x0000, 0x0000, 0x5555, 0xaaaa,
58 0x5555, 0x5555, 0xffff, 0xffff, 0x5555, 0x5555, 0xffff, 0xffff
60 static u16 blue16
[] = {
61 0x0000, 0xaaaa, 0x0000, 0xaaaa, 0x0000, 0xaaaa, 0x0000, 0xaaaa,
62 0x5555, 0xffff, 0x5555, 0xffff, 0x5555, 0xffff, 0x5555, 0xffff
65 static struct fb_cmap default_2_colors
= {
66 0, 2, red2
, green2
, blue2
, NULL
68 static struct fb_cmap default_8_colors
= {
69 0, 8, red8
, green8
, blue8
, NULL
71 static struct fb_cmap default_4_colors
= {
72 0, 4, red4
, green4
, blue4
, NULL
74 static struct fb_cmap default_16_colors
= {
75 0, 16, red16
, green16
, blue16
, NULL
80 * fb_alloc_cmap - allocate a colormap
81 * @cmap: frame buffer colormap structure
82 * @len: length of @cmap
83 * @transp: boolean, 1 if there is transparency, 0 otherwise
85 * Allocates memory for a colormap @cmap. @len is the
86 * number of entries in the palette.
88 * Returns -1 errno on error, or zero on success.
92 int fb_alloc_cmap(struct fb_cmap
*cmap
, int len
, int transp
)
94 int size
= len
*sizeof(u16
);
96 if (cmap
->len
!= len
) {
97 fb_dealloc_cmap(cmap
);
100 if (!(cmap
->red
= kmalloc(size
, GFP_ATOMIC
)))
102 if (!(cmap
->green
= kmalloc(size
, GFP_ATOMIC
)))
104 if (!(cmap
->blue
= kmalloc(size
, GFP_ATOMIC
)))
107 if (!(cmap
->transp
= kmalloc(size
, GFP_ATOMIC
)))
114 fb_copy_cmap(fb_default_cmap(len
), cmap
, 0);
119 * fb_dealloc_cmap - deallocate a colormap
120 * @cmap: frame buffer colormap structure
122 * Deallocates a colormap that was previously allocated with
127 void fb_dealloc_cmap(struct fb_cmap
*cmap
)
138 cmap
->red
= cmap
->green
= cmap
->blue
= cmap
->transp
= NULL
;
143 * fb_copy_cmap - copy a colormap
144 * @from: frame buffer colormap structure
145 * @to: frame buffer colormap structure
146 * @fsfromto: determine copy method
148 * Copy contents of colormap from @from to @to.
150 * @fsfromto accepts the following integer parameters:
152 * 1: copy_from_user() function to copy from userspace
153 * 2: copy_to_user() function to copy to userspace
157 int fb_copy_cmap(struct fb_cmap
*from
, struct fb_cmap
*to
, int fsfromto
)
159 int tooff
= 0, fromoff
= 0;
162 if (to
->start
> from
->start
)
163 fromoff
= to
->start
-from
->start
;
165 tooff
= from
->start
-to
->start
;
166 size
= to
->len
-tooff
;
167 if (size
> (int) (from
->len
- fromoff
))
168 size
= from
->len
-fromoff
;
175 memcpy(to
->red
+tooff
, from
->red
+fromoff
, size
);
176 memcpy(to
->green
+tooff
, from
->green
+fromoff
, size
);
177 memcpy(to
->blue
+tooff
, from
->blue
+fromoff
, size
);
178 if (from
->transp
&& to
->transp
)
179 memcpy(to
->transp
+tooff
, from
->transp
+fromoff
, size
);
182 if (copy_from_user(to
->red
+tooff
, from
->red
+fromoff
, size
))
184 if (copy_from_user(to
->green
+tooff
, from
->green
+fromoff
, size
))
186 if (copy_from_user(to
->blue
+tooff
, from
->blue
+fromoff
, size
))
188 if (from
->transp
&& to
->transp
)
189 if (copy_from_user(to
->transp
+tooff
, from
->transp
+fromoff
, size
))
193 if (copy_to_user(to
->red
+tooff
, from
->red
+fromoff
, size
))
195 if (copy_to_user(to
->green
+tooff
, from
->green
+fromoff
, size
))
197 if (copy_to_user(to
->blue
+tooff
, from
->blue
+fromoff
, size
))
199 if (from
->transp
&& to
->transp
)
200 if (copy_to_user(to
->transp
+tooff
, from
->transp
+fromoff
, size
))
208 * fb_set_cmap - set the colormap
209 * @cmap: frame buffer colormap structure
210 * @kspc: boolean, 0 copy local, 1 get_user() function
211 * @info: frame buffer info structure
213 * Sets the colormap @cmap for a screen of device @info.
215 * Returns negative errno on error, or zero on success.
219 int fb_set_cmap(struct fb_cmap
*cmap
, int kspc
, struct fb_info
*info
)
222 u16
*red
, *green
, *blue
, *transp
;
223 u_int hred
, hgreen
, hblue
, htransp
;
228 transp
= cmap
->transp
;
231 if (start
< 0 || !info
->fbops
->fb_setcolreg
)
233 for (i
= 0; i
< cmap
->len
; i
++) {
238 htransp
= transp
? *transp
: 0xffff;
241 get_user(hgreen
, green
);
242 get_user(hblue
, blue
);
244 get_user(htransp
, transp
);
253 if (info
->fbops
->fb_setcolreg(start
++, hred
, hgreen
, hblue
, htransp
, info
))
261 * fb_default_cmap - get default colormap
262 * @len: size of palette for a depth
264 * Gets the default colormap for a specific screen depth. @len
265 * is the size of the palette for a particular screen depth.
267 * Returns pointer to a frame buffer colormap structure.
271 struct fb_cmap
*fb_default_cmap(int len
)
274 return &default_2_colors
;
276 return &default_4_colors
;
278 return &default_8_colors
;
279 return &default_16_colors
;
284 * fb_invert_cmaps - invert all defaults colormaps
286 * Invert all default colormaps.
290 void fb_invert_cmaps(void)
294 for (i
= 0; i
< 2; i
++) {
296 green2
[i
] = ~green2
[i
];
297 blue2
[i
] = ~blue2
[i
];
299 for (i
= 0; i
< 4; i
++) {
301 green4
[i
] = ~green4
[i
];
302 blue4
[i
] = ~blue4
[i
];
304 for (i
= 0; i
< 8; i
++) {
306 green8
[i
] = ~green8
[i
];
307 blue8
[i
] = ~blue8
[i
];
309 for (i
= 0; i
< 16; i
++) {
310 red16
[i
] = ~red16
[i
];
311 green16
[i
] = ~green16
[i
];
312 blue16
[i
] = ~blue16
[i
];
318 * Visible symbols for modules
321 EXPORT_SYMBOL(fb_alloc_cmap
);
322 EXPORT_SYMBOL(fb_dealloc_cmap
);
323 EXPORT_SYMBOL(fb_copy_cmap
);
324 EXPORT_SYMBOL(fb_set_cmap
);
325 EXPORT_SYMBOL(fb_default_cmap
);
326 EXPORT_SYMBOL(fb_invert_cmaps
);