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);
118 fb_dealloc_cmap(cmap);
123 * fb_dealloc_cmap - deallocate a colormap
124 * @cmap: frame buffer colormap structure
126 * Deallocates a colormap that was previously allocated with
131 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, 1 copy local, 0 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);