view loadtools/hwparam.c @ 786:b761029f9c03

simagent: spenh command implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 13 Mar 2021 22:41:33 +0000
parents 0dd2c87c1b63
children
line wrap: on
line source

/*
 * This module contains the code that reads the hardware parameter files
 * specified with -h or -H, and sets variables for later use by other code.
 */

#include <sys/param.h>
#include <stdio.h>
#include <ctype.h>
#include <string.h>
#include <strings.h>
#include <stdlib.h>

extern char default_helpers_dir[];

extern void set_boot_reflash_hack();
extern void set_default_exit_mode();
extern void set_flash_config();

char hw_init_script[128];

static void
handle_compal_stage(arg, filename_for_errs, lineno_for_errs)
	char *arg;
	char *filename_for_errs;
	int lineno_for_errs;
{
	char *cp;

	while (isspace(*arg))
		arg++;
	if (!*arg) {
		fprintf(stderr,
		"%s line %d: compal-stage setting requires an argument\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	for (cp = arg; *cp && !isspace(*cp); cp++)
		;
	*cp = '\0';
	set_compalstage_short(arg);
}

static void
handle_init_script(arg, filename_for_errs, lineno_for_errs)
	char *arg;
	char *filename_for_errs;
	int lineno_for_errs;
{
	char *cp;

	while (isspace(*arg))
		arg++;
	if (!*arg) {
		fprintf(stderr,
		"%s line %d: init-script setting requires an argument\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	for (cp = arg; *cp && !isspace(*cp); cp++)
		;
	*cp = '\0';
	if (cp - arg > sizeof(hw_init_script) - 1) {
		fprintf(stderr,
	"%s line %d: init-script argument is too long (buffer overflow)\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	strcpy(hw_init_script, arg);
}

static void
handle_pll_config(arg, filename_for_errs, lineno_for_errs)
	char *arg;
	char *filename_for_errs;
	int lineno_for_errs;
{
	int mult, div;

	while (isspace(*arg))
		arg++;
	if (!isdigit(*arg)) {
inv:		fprintf(stderr, "%s line %d: pll-config argument must be M/N\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	mult = atoi(arg);
	arg++;
	if (isdigit(*arg))
		arg++;
	if (*arg++ != '/')
		goto inv;
	if (!isdigit(*arg))
		goto inv;
	div = atoi(arg);
	arg++;
	if (*arg && !isspace(*arg))
		goto inv;
	if (mult < 0 || mult > 31 || div < 1 || div > 4) {
		fprintf(stderr,
			"%s line %d: pll-config argument is out of range\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	set_romload_pll_conf((mult << 2) | (div - 1));
}

static void
handle_rhea_cntl(arg, filename_for_errs, lineno_for_errs)
	char *arg;
	char *filename_for_errs;
	int lineno_for_errs;
{
	int byte;

	while (isspace(*arg))
		arg++;
	if (arg[0] == '0' && (arg[1] == 'x' || arg[1] == 'X'))
		arg += 2;
	byte = decode_hex_byte(arg);
	if (byte < 0 || arg[2] && !isspace(arg[2])) {
		fprintf(stderr,
		"%s line %d: rhea-cntl argument must be a hex byte value\n",
			filename_for_errs, lineno_for_errs);
		exit(1);
	}
	set_romload_rhea_cntl(byte);
}

static struct cmdtab {
	char *name;
	void (*func)();
} cmdtab[] = {
	{"boot-reflash-hack", set_boot_reflash_hack},
	{"compal-stage", handle_compal_stage},
	{"exit-mode", set_default_exit_mode},
	{"flash", set_flash_config},
	{"init-script", handle_init_script},
	{"pll-config", handle_pll_config},
	{"rhea-cntl", handle_rhea_cntl},
	{0, 0}
};

void
read_hwparam_file_fullpath(filename)
	char *filename;
{
	FILE *f;
	char linebuf[512];
	int lineno;
	char *cp, *np;
	struct cmdtab *tp;

	f = fopen(filename, "r");
	if (!f) {
		perror(filename);
		exit(1);
	}
	for (lineno = 1; fgets(linebuf, sizeof linebuf, f); lineno++) {
		for (cp = linebuf; isspace(*cp); cp++)
			;
		if (!*cp || *cp == '#')
			continue;
		for (np = cp; *cp && !isspace(*cp); cp++)
			;
		if (*cp)
			*cp++ = '\0';
		for (tp = cmdtab; tp->name; tp++)
			if (!strcmp(tp->name, np))
				break;
		if (tp->func)
			tp->func(cp, filename, lineno);
		else {
			fprintf(stderr,
				"%s line %d: setting \"%s\" not understood\n",
				filename, lineno, np);
			exit(1);
		}
	}
	fclose(f);
}

void
read_hwparam_file_shortname(confname)
	char *confname;
{
	char pathname[MAXPATHLEN];

	sprintf(pathname, "%s/%s.config", default_helpers_dir, confname);
	read_hwparam_file_fullpath(pathname);
}