/*      $NetBSD: palette.c,v 1.8 2011/05/19 21:26:39 tsutsui Exp $      */
/*
* pelette - manipulate text colormap for NetBSD/x68k.
* author: Masaru Oki
*
* This software is in the Public Domain.
*/

#include <sys/cdefs.h>
__RCSID("$NetBSD: palette.c,v 1.8 2011/05/19 21:26:39 tsutsui Exp $");

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/param.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/fcntl.h>

#define PALETTE_OFFSET 0x2000 /* physical addr: 0xe82000 */
#define PALETTE_SIZE   0x1000 /* at least 1 page */

int
main(int argc, char *argv[])
{
       int fd;
       u_short *palette;
       char *mapaddr;
       int r, g, b;
       int c = 7;

#ifdef DEBUG
{
       int i;
       printf("argc = %d\n", argc);
       for (i = 0; i < argc; i++)
               printf("argv[%d] = \"%s\"\n", i, argv[i]);
}
#endif

       if ((fd = open("/dev/grf0", O_RDWR, 0)) < 0) {
               perror("open");
               exit(1);
       }

       mapaddr = mmap(0, PALETTE_SIZE, PROT_READ | PROT_WRITE,
                      MAP_FILE | MAP_SHARED, fd, PALETTE_OFFSET);
       if (mapaddr == (void *)-1) {
               perror("mmap");
               close(fd);
               exit(1);
       }
       close(fd);
       palette = (u_short *)(mapaddr + 0x0200);

       if (argc == 5) {
               c = atoi(argv[--argc]);
               if (c > 15) {
                       printf("Usage: %s [red green blue [code]]\n", argv[0]);
                       exit(1);
               }
       }
       if (argc != 4)
               r = g = b = 31;
       else {
               r = atoi(argv[1]);
               g = atoi(argv[2]);
               b = atoi(argv[3]);
               if (r > 31 || g > 31 || b > 31) {
                       printf("Usage: %s [red green blue [code]]\n", argv[0]);
                       r = g = b = 31;
               }
       }
#ifdef DEBUG
       printf("color table offset = %d\n", c);
       printf("r = %d, g = %d, b = %d\n", r, g, b);
#endif
       r <<= 6;
       g <<= 11;
       b <<= 1;

       palette[c] = r | g | b | 1;

       exit(0);
}