/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License, Version 1.0 only
 * (the "License").  You may not use this file except in compliance
 * with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 2004 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

/* Copyright (c) 1984, 1986, 1987, 1988, 1989 AT&T */
/* All Rights Reserved */

#include	<stdio.h>
#include	<stdlib.h>
#include	<string.h>
#include	<unistd.h>
#include	<sys/types.h>
#include	<sys/priocntl.h>
#include	<sys/fxpriocntl.h>
#include	<sys/param.h>
#include	<errno.h>
#include	<sys/fx.h>

#include	"dispadmin.h"

/*
 * This file contains the class specific code implementing
 * the fixed-priority dispadmin sub-command.
 */

#define	BASENMSZ	16

extern char	*basename();

static void	get_fxdptbl(), set_fxdptbl();

static char usage[] = "usage:	dispadmin -l\n"
			    "dispadmin -c FX -g [-r res]\n"
			    "dispadmin -c FX -s infile\n";

static char	basenm[BASENMSZ];
static char	cmdpath[256];


int
main(int argc, char **argv)
{
	int		c;
	int		lflag, gflag, rflag, sflag;
	ulong_t		res;
	char		*infile;
	char 		*endp;

	(void) strcpy(cmdpath, argv[0]);
	(void) strcpy(basenm, basename(argv[0]));
	lflag = gflag = rflag = sflag = 0;
	while ((c = getopt(argc, argv, "lc:gr:s:")) != -1) {
		switch (c) {

		case 'l':
			lflag++;
			break;

		case 'c':
			if (strcmp(optarg, "FX") != 0)
				fatalerr("error: %s executed for %s class, "
				    "%s is actually sub-command for FX class\n",
				    cmdpath, optarg, cmdpath);
			break;

		case 'g':
			gflag++;
			break;

		case 'r':
			rflag++;
			errno = 0;
			res = strtoul(optarg, &endp, 10);
			if (res == 0 || errno != 0 || *endp != '\0')
				fatalerr("%s: Can't convert to requested "
				    "resolution\n", basenm);
			break;

		case 's':
			sflag++;
			infile = optarg;
			break;

		case '?':
			fatalerr(usage);

		default:
			break;
		}
	}


	if (lflag) {
		if (gflag || rflag || sflag)
			fatalerr(usage);

		(void) printf("FX\t(Fixed Priority)\n");
		return (0);

	} else if (gflag) {
		if (sflag)
			fatalerr(usage);

		if (rflag == 0)
			res = 1000;

		get_fxdptbl(res);
		return (0);

	} else if (sflag) {
		if (rflag)
			fatalerr(usage);

		set_fxdptbl(infile);
		return (0);

	} else {
		fatalerr(usage);
	}
	return (1);
}


/*
 * Retrieve the current fx_dptbl from memory, convert the time quantum
 * values to the resolution specified by res and write the table to stdout.
 */
static void
get_fxdptbl(ulong_t res)
{
	int		i;
	int		fxdpsz;
	pcinfo_t	pcinfo;
	pcadmin_t	pcadmin;
	fxadmin_t	fxadmin;
	fxdpent_t	*fx_dptbl;
	hrtimer_t	hrtime;

	(void) strcpy(pcinfo.pc_clname, "FX");
	if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1)
		fatalerr("%s: Can't get FX class ID, priocntl system call "
		    "failed with errno %d\n", basenm, errno);

	pcadmin.pc_cid = pcinfo.pc_cid;
	pcadmin.pc_cladmin = (char *)&fxadmin;
	fxadmin.fx_cmd = FX_GETDPSIZE;

	if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1)
		fatalerr("%s: Can't get fx_dptbl size, priocntl system call "
		    "failed with errno %d\n", basenm, errno);

	fxdpsz = fxadmin.fx_ndpents * sizeof (fxdpent_t);
	if ((fx_dptbl = (fxdpent_t *)malloc(fxdpsz)) == NULL)
		fatalerr("%s: Can't allocate memory for fx_dptbl\n", basenm);

	fxadmin.fx_dpents = fx_dptbl;

	fxadmin.fx_cmd = FX_GETDPTBL;
	if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1)
		fatalerr("%s: Can't get fx_dptbl, priocntl system call "
		    "failed with errno %d\n", basenm, errno);

	(void) printf("# Fixed Priority Dispatcher Configuration\n");
	(void) printf("RES=%ld\n\n", res);
	(void) printf("# TIME QUANTUM                    PRIORITY\n");
	(void) printf("# (fx_quantum)                      LEVEL\n");

	for (i = 0; i < fxadmin.fx_ndpents; i++) {
		if (res != HZ && fx_dptbl[i].fx_quantum != FX_TQINF) {
			hrtime.hrt_secs = 0;
			hrtime.hrt_rem = fx_dptbl[i].fx_quantum;
			hrtime.hrt_res = HZ;
			if (_hrtnewres(&hrtime, res, HRT_RNDUP) == -1)
				fatalerr("%s: Can't convert to requested "
				    "resolution\n", basenm);
			if ((fx_dptbl[i].fx_quantum = hrtconvert(&hrtime))
									== -1)
				fatalerr("%s: Can't express time quantum in "
				    "requested resolution,\n"
				    "try coarser resolution\n", basenm);
		}
		(void) printf("%10d                    #      %3d\n",
		    fx_dptbl[i].fx_quantum, i);
	}
}


/*
 * Read the fx_dptbl values from infile, convert the time quantum values
 * to HZ resolution, do a little sanity checking and overwrite the table
 * in memory with the values from the file.
 */
static void
set_fxdptbl(char *infile)
{
	int		i;
	int		nfxdpents;
	char		*tokp;
	pcinfo_t	pcinfo;
	pcadmin_t	pcadmin;
	fxadmin_t	fxadmin;
	fxdpent_t	*fx_dptbl;
	int		linenum;
	ulong_t		res;
	hrtimer_t	hrtime;
	FILE		*fp;
	char		buf[512];
	int		wslength;
	char 		*endp;
	char		name[512], value[512];
	int		len;

	(void) strcpy(pcinfo.pc_clname, "FX");
	if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1)
		fatalerr("%s: Can't get FX class ID, priocntl system call "
		    "failed with errno %d\n", basenm, errno);

	pcadmin.pc_cid = pcinfo.pc_cid;
	pcadmin.pc_cladmin = (char *)&fxadmin;
	fxadmin.fx_cmd = FX_GETDPSIZE;

	if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1)
		fatalerr("%s: Can't get fx_dptbl size, priocntl system call "
		    "failed with errno %d\n", basenm, errno);

	nfxdpents = fxadmin.fx_ndpents;
	if ((fx_dptbl =
	    (fxdpent_t *)malloc(nfxdpents * sizeof (fxdpent_t))) == NULL)
		fatalerr("%s: Can't allocate memory for fx_dptbl\n", basenm);

	if ((fp = fopen(infile, "r")) == NULL)
		fatalerr("%s: Can't open %s for input\n", basenm, infile);

	linenum = 0;

	/*
	 * Find the first non-blank, non-comment line.  A comment line
	 * is any line with '#' as the first non-white-space character.
	 */
	do {
		if (fgets(buf, sizeof (buf), fp) == NULL)
			fatalerr("%s: Too few lines in input table\n", basenm);
		linenum++;
	} while (buf[0] == '#' || buf[0] == '\0' ||
	    (wslength = strspn(buf, " \t\n")) == strlen(buf) ||
	    strchr(buf, '#') == buf + wslength);

	/* LINTED - unbounded string specifier */
	if (sscanf(buf, " %[^=]=%s \n%n", name, value, &len) == 2 &&
	    name[0] != '\0' && value[0] != '\0' && len == strlen(buf)) {

		if (strcmp(name, "RES") == 0) {
			errno = 0;
			i = (int)strtol(value, &endp, 10);
			if (errno != 0 || endp == value ||
			    i < 0 || *endp != '\0')
				fatalerr("%s: Bad RES specification, "
				    "line %d of input file\n", basenm, linenum);
			else
				res = i;
		} else {
			fatalerr("%s: Bad RES specification, "
			    "line %d of input file\n", basenm, linenum);
		}
	}

	/*
	 * The remainder of the input file should contain exactly enough
	 * non-blank, non-comment lines to fill the table (fx_ndpents lines).
	 * We assume that any non-blank, non-comment line is data for the
	 * table and fail if we find more or less than we need.
	 */
	for (i = 0; i < fxadmin.fx_ndpents; i++) {

		/*
		 * Get the next non-blank, non-comment line.
		 */
		do {
			if (fgets(buf, sizeof (buf), fp) == NULL)
				fatalerr("%s: Too few lines in input table\n",
				    basenm);
			linenum++;
		} while (buf[0] == '#' || buf[0] == '\0' ||
		    (wslength = strspn(buf, " \t\n")) == strlen(buf) ||
		    strchr(buf, '#') == buf + wslength);

		if ((tokp = strtok(buf, " \t")) == NULL)
			fatalerr("%s: Too few values, line %d of input file\n",
			    basenm, linenum);

		fx_dptbl[i].fx_quantum = atol(tokp);
		if (fx_dptbl[i].fx_quantum <= 0) {
				fatalerr("%s: fx_quantum value out of "
				    "valid range; line %d of input,\n"
				    "table not overwritten\n", basenm, linenum);
		} else if (res != HZ) {
			hrtime.hrt_secs = 0;
			hrtime.hrt_rem = fx_dptbl[i].fx_quantum;
			hrtime.hrt_res = res;
			if (_hrtnewres(&hrtime, HZ, HRT_RNDUP) == -1)
				fatalerr("%s: Can't convert specified "
				    "resolution to ticks\n", basenm);
			if ((fx_dptbl[i].fx_quantum =
			    hrtconvert(&hrtime)) == -1)
				fatalerr("%s: fx_quantum value out of "
				    "valid range; line %d of input,\n"
				    "table not overwritten\n", basenm, linenum);
		}

		if ((tokp = strtok(NULL, " \t")) != NULL && tokp[0] != '#')
			fatalerr("%s: Too many values, line %d of input file\n",
			    basenm, linenum);
	}

	/*
	 * We've read enough lines to fill the table.  We fail
	 * if the input file contains any more.
	 */
	while (fgets(buf, sizeof (buf), fp) != NULL) {
		if (buf[0] != '#' && buf[0] != '\0' &&
		    (wslength = strspn(buf, " \t\n")) != strlen(buf) &&
		    strchr(buf, '#') != buf + wslength)
			fatalerr("%s: Too many lines in input table\n",
				basenm);
	}

	fxadmin.fx_dpents = fx_dptbl;
	fxadmin.fx_cmd = FX_SETDPTBL;
	if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1)
		fatalerr("%s: Can't set fx_dptbl, priocntl system call failed "
		    "with errno %d\n", basenm, errno);
}