775fee61ee875414a13edc3088403a7703e8e571
[platform/upstream/kbd.git] / src / setpalette.c
1 #include "config.h"
2
3 #include <stdio.h>
4 #include <stdlib.h>
5 #include <errno.h>
6 #include <sys/ioctl.h>
7 #include <linux/kd.h>
8 #include "getfd.h"
9 #include "version.h"
10 #include "kbd_error.h"
11
12 int main(int argc, char **argv)
13 {
14         int fd, indx, red, green, blue;
15         unsigned char cmap[48];
16
17         set_progname(argv[0]);
18
19         if (argc != 5) {
20                 fprintf(stderr, "usage: %s index red green blue\n", progname);
21                 exit(EXIT_FAILURE);
22         }
23
24         indx  = atoi(argv[1]);
25         red   = atoi(argv[2]);
26         green = atoi(argv[3]);
27         blue  = atoi(argv[4]);
28
29         if (indx < 0 || red < 0 || green < 0 || blue < 0 ||
30             indx > 15 || red > 255 || green > 255 || blue > 255) {
31                 fprintf(stderr, "indx must be in 0..15, colors in 0..255\n");
32                 exit(EXIT_FAILURE);
33         }
34
35         if ((fd = getfd(NULL)) < 0)
36                 kbd_error(EXIT_FAILURE, 0, _("Couldn't get a file descriptor referring to the console"));
37
38         if (ioctl(fd, GIO_CMAP, cmap))
39                 kbd_error(EXIT_FAILURE, errno, "ioctl GIO_CMAP");
40
41         cmap[3 * indx]     = red;
42         cmap[3 * indx + 1] = green;
43         cmap[3 * indx + 2] = blue;
44
45         if (ioctl(fd, PIO_CMAP, cmap))
46                 kbd_error(EXIT_FAILURE, errno, "ioctl PIO_CMAP");
47
48         return EXIT_SUCCESS;
49 }