/*      $NetBSD: grfconfig.c,v 1.16 2016/02/29 18:59:52 christos Exp $  */

/*-
* Copyright (c) 1997 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Ezra Story and Bernd Ernesti.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
*    notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
*    notice, this list of conditions and the following disclaimer in the
*    documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/

#include <sys/cdefs.h>
#ifndef lint
__COPYRIGHT("@(#) Copyright (c) 1997\
The NetBSD Foundation, Inc.  All rights reserved.");
#endif /* not lint */

#ifndef lint
__RCSID("$NetBSD: grfconfig.c,v 1.16 2016/02/29 18:59:52 christos Exp $");
#endif /* not lint */

#include <sys/file.h>
#include <sys/ioctl.h>
#include <err.h>
#include <ctype.h>
#include <limits.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include <amiga/dev/grfioctl.h>

static void print_modeline(FILE *fp, struct grfvideo_mode *, int);
static void suggest(struct grfvideo_mode *, const char *, const char *);

static struct grf_flag {
       u_short grf_flag_number;
       const char      *grf_flag_name;
} grf_flags[] = {
       {GRF_FLAGS_DBLSCAN,             "doublescan"},
       {GRF_FLAGS_LACE,                "interlace"},
       {GRF_FLAGS_PHSYNC,              "+hsync"},
       {GRF_FLAGS_NHSYNC,              "-hsync"},
       {GRF_FLAGS_PVSYNC,              "+vsync"},
       {GRF_FLAGS_NVSYNC,              "-vsync"},
       {GRF_FLAGS_SYNC_ON_GREEN,       "sync-on-green"},
       {0,                             0}
};

/*
* Dynamic mode loader for NetBSD/Amiga grf devices.
*/
int
main(int ac, char  **av)
{
       struct  grfvideo_mode gv[1];
       struct  grf_flag *grf_flagp;
       FILE    *fp;
       int     c, y, grffd;
       size_t  i;
       int     lineno = 0;
       int     uplim, lowlim;
       char    rawdata = 0, testmode = 0;
       char    *grfdevice = 0, *ptr;
       char    *modefile = 0;
       char    buf[_POSIX2_LINE_MAX];
       char    *cps[31];
       char    *p;
       const char      *errortext;


       while ((c = getopt(ac, av, "rt")) != -1) {
               switch (c) {
               case 'r':       /* raw output */
                       rawdata = 1;
                       break;
               case 't':       /* test the modefile without setting it */
                       testmode = 1;
                       break;
               default:
                       printf("grfconfig [-r] device [file]\n");
                       return (1);
               }
       }
       ac -= optind;
       av += optind;


       if (ac < 1)
               errx(EXIT_FAILURE, "No grf device specified");
       grfdevice = av[0];

       if (ac >= 2)
               modefile = av[1];

       if ((grffd = open(grfdevice, O_RDWR)) == -1)
               err(EXIT_FAILURE, "Can't open grf device `%s'", grfdevice);

       /* If a mode file is specificied, load it in, don't display any info. */

       if (modefile) {
               if (!(fp = fopen(modefile, "r")))
                       err(EXIT_FAILURE,
                           "Cannot open mode definition file `%s'", modefile);

               while (fgets(buf, sizeof(buf), fp)) {
                       char *obuf, tbuf[_POSIX2_LINE_MAX], *tbuf2;
                       /*
                        * check for end-of-section, comments, strip off trailing
                        * spaces and newline character.
                        */
                       for (p = buf; isspace((unsigned char)*p); ++p)
                               continue;
                       if (*p == '\0' || *p == '#')
                               continue;
                       for (p = strchr(buf, '\0'); isspace((unsigned char)*--p);)
                               continue;
                       *++p = '\0';

                       obuf = buf;
                       tbuf2 = tbuf;
                       while ((*tbuf2 = *obuf) != '\0') {
                               if (*tbuf2 == '#') {
                                       *tbuf2 = '\0';
                                       break;
                               }
                               if (isupper((unsigned char)*tbuf2)) {
                                       *tbuf2 = tolower((unsigned char)*tbuf2);
                               }
                               obuf++;
                               tbuf2++;
                       }
                       obuf = tbuf;

                       lineno = lineno + 1;

#define SP " \b\t\r\n"
                       memset(cps, 0, sizeof(cps));
                       for (i = 0, ptr = strtok(buf, SP);
                           ptr != NULL && i < __arraycount(cps);
                           i++, ptr = strtok(NULL, SP))
                               cps[i] = ptr;


                       if (i < 14)
                               errx(EXIT_FAILURE, "Too few values in mode "
                                   "definition file: `%s'\n", obuf);

                       gv->pixel_clock = atoi(cps[1]);
                       gv->disp_width  = atoi(cps[2]);
                       gv->disp_height = atoi(cps[3]);
                       gv->depth       = atoi(cps[4]);
                       gv->hblank_start        = atoi(cps[5]);
                       gv->hsync_start = atoi(cps[6]);
                       gv->hsync_stop  = atoi(cps[7]);
                       gv->htotal      = atoi(cps[8]);
                       gv->vblank_start        = atoi(cps[9]);
                       gv->vsync_start = atoi(cps[10]);
                       gv->vsync_stop  = atoi(cps[11]);
                       gv->vtotal      = atoi(cps[12]);

                       if ((y = atoi(cps[0])))
                               gv->mode_num = y;
                       else
                               if (strncasecmp("c", cps[0], 1) == 0) {
                                       gv->mode_num = 255;
                                       gv->depth = 4;
                               } else {
                                       errx(EXIT_FAILURE,
                                           "Illegal mode number: %s", cps[0]);
                               }

                       if ((gv->pixel_clock == 0) ||
                           (gv->disp_width == 0) ||
                           (gv->disp_height == 0) ||
                           (gv->depth == 0) ||
                           (gv->hblank_start == 0) ||
                           (gv->hsync_start == 0) ||
                           (gv->hsync_stop == 0) ||
                           (gv->htotal == 0) ||
                           (gv->vblank_start == 0) ||
                           (gv->vsync_start == 0) ||
                           (gv->vsync_stop == 0) ||
                           (gv->vtotal == 0)) {
                               errx(EXIT_FAILURE, "Illegal value in "
                                   "mode #%d: `%s'", gv->mode_num, obuf);
                       }

                       if (strstr(obuf, "default") != NULL) {
                               gv->disp_flags = GRF_FLAGS_DEFAULT;
                       } else {
                               gv->disp_flags = GRF_FLAGS_DEFAULT;
                               for (grf_flagp = grf_flags;
                                 grf_flagp->grf_flag_number; grf_flagp++) {
                                   if (strstr(obuf, grf_flagp->grf_flag_name) != NULL) {
                                       gv->disp_flags |= grf_flagp->grf_flag_number;
                                   }
                               }
                               if (gv->disp_flags == GRF_FLAGS_DEFAULT)
                                       errx(EXIT_FAILURE, "Your are using a "
                                           "mode file with an obsolete "
                                           "format");
                       }

                       /*
                        * Check for impossible gv->disp_flags:
                        * doublescan and interlace,
                        * +hsync and -hsync
                        * +vsync and -vsync.
                        */
                       errortext = NULL;
                       if ((gv->disp_flags & GRF_FLAGS_DBLSCAN) &&
                           (gv->disp_flags & GRF_FLAGS_LACE))
                               errortext = "Interlace and Doublescan";
                       if ((gv->disp_flags & GRF_FLAGS_PHSYNC) &&
                           (gv->disp_flags & GRF_FLAGS_NHSYNC))
                               errortext = "+hsync and -hsync";
                       if ((gv->disp_flags & GRF_FLAGS_PVSYNC) &&
                           (gv->disp_flags & GRF_FLAGS_NVSYNC))
                               errortext = "+vsync and -vsync";

                       if (errortext != NULL)
                               errx(EXIT_FAILURE, "Illegal flags in "
                                   "mode #%d: `%s' are both defined",
                                   gv->mode_num, errortext);

                       /* Check for old horizontal cycle values */
                       if ((gv->htotal < (gv->disp_width / 4))) {
                               gv->hblank_start *= 8;
                               gv->hsync_start *= 8;
                               gv->hsync_stop *= 8;
                               gv->htotal *= 8;
                               suggest(gv, "horizontal videoclock cycle "
                                   "values", obuf);
                               return EXIT_FAILURE;
                       }

                       /* Check for old interlace or doublescan modes */
                       uplim = gv->disp_height + (gv->disp_height / 4);
                       lowlim = gv->disp_height - (gv->disp_height / 4);
                       if (((gv->vtotal * 2) > lowlim) &&
                           ((gv->vtotal * 2) < uplim)) {
                               gv->vblank_start *= 2;
                               gv->vsync_start *= 2;
                               gv->vsync_stop *= 2;
                               gv->vtotal *= 2;
                               gv->disp_flags &= ~GRF_FLAGS_DBLSCAN;
                               gv->disp_flags |= GRF_FLAGS_LACE;
                               suggest(gv, "vertical values for interlace "
                                   "modes", obuf);
                               return EXIT_FAILURE;
                       } else if (((gv->vtotal / 2) > lowlim) &&
                           ((gv->vtotal / 2) < uplim)) {
                               gv->vblank_start /= 2;
                               gv->vsync_start /= 2;
                               gv->vsync_stop /= 2;
                               gv->vtotal /= 2;
                               gv->disp_flags &= ~GRF_FLAGS_LACE;
                               gv->disp_flags |= GRF_FLAGS_DBLSCAN;
                               suggest(gv, "vertical values for doublescan "
                                   "modes", obuf);
                               return EXIT_FAILURE;
                       }

                       if (testmode == 1) {
                               if (lineno == 1)
                                       printf("num clk wid hi dep hbs "
                                           "hss hse ht vbs vss vse vt "
                                           "flags\n");
                               print_modeline(stdout, gv, 1);
                       } else {
                               gv->mode_descr[0] = 0;
                               if (ioctl(grffd, GRFIOCSETMON, (char *) gv) < 0)
                                       err(EXIT_FAILURE, "bad monitor "
                                           "definition for mode #%d",
                                           gv->mode_num);
                       }
               }
               fclose(fp);
       } else {
               ioctl(grffd, GRFGETNUMVM, &y);
               y += 2;
               for (c = 1; c < y; c++) {
                       c = gv->mode_num = (c != (y - 1)) ? c : 255;
                       if (ioctl(grffd, GRFGETVMODE, gv) < 0)
                               continue;
                       if (rawdata) {
                               print_modeline(stdout, gv, 0);
                               continue;
                       }
                       if (c == 255)
                               printf("Console: ");
                       else
                               printf("%2d: ", gv->mode_num);

                       printf("%dx%d",
                           gv->disp_width,
                           gv->disp_height);

                       if (c != 255)
                               printf("x%d", gv->depth);
                       else
                               printf(" (%dx%d)",
                                   gv->disp_width / 8,
                                   gv->disp_height / gv->depth);

                       printf("\t%ld.%ldkHz @ %ldHz",
                           gv->pixel_clock / (gv->htotal * 1000),
                           (gv->pixel_clock / (gv->htotal * 100))
                               % 10,
                           gv->pixel_clock / (gv->htotal * gv->vtotal));
                       printf(" flags:");

                       if (gv->disp_flags == GRF_FLAGS_DEFAULT) {
                               printf(" default\n");
                               continue;
                       }

                       for (grf_flagp = grf_flags;
                           grf_flagp->grf_flag_number; grf_flagp++)
                               if (gv->disp_flags & grf_flagp->grf_flag_number)
                                       printf(" %s", grf_flagp->grf_flag_name);
                       printf("\n");
               }
       }

       close(grffd);
       return EXIT_SUCCESS;
}

static void
suggest(struct  grfvideo_mode *gv, const char *d, const char *s)
{
       warnx("Old and no longer supported %s: %s", d, s);
       warnx("Wrong mode line, this could be a possible good model line:");
       fprintf(stderr, "%s: ", getprogname());
       print_modeline(stderr, gv, 0);
}

static void
print_modeline(FILE *fp, struct grfvideo_mode *gv, int rawflags)
{
       struct  grf_flag *grf_flagp;

       if (gv->mode_num == 255)
               fprintf(fp, "c ");
       else
               fprintf(fp, "%d ", gv->mode_num);

       fprintf(fp, "%ld %d %d %d %d %d %d %d %d %d %d %d",
               gv->pixel_clock,
               gv->disp_width,
               gv->disp_height,
               gv->depth,
               gv->hblank_start,
               gv->hsync_start,
               gv->hsync_stop,
               gv->htotal,
               gv->vblank_start,
               gv->vsync_start,
               gv->vsync_stop,
               gv->vtotal);

       if (rawflags) {
               fprintf(fp, " 0x%.2x\n", gv->disp_flags);
               return;
       }
       if (gv->disp_flags == GRF_FLAGS_DEFAULT) {
               fprintf(fp, " default\n");
               return;
       }

       for (grf_flagp = grf_flags; grf_flagp->grf_flag_number; grf_flagp++)
               if (gv->disp_flags & grf_flagp->grf_flag_number)
                       fprintf(fp, " %s", grf_flagp->grf_flag_name);
       fprintf(fp, "\n");
}