view loadtools/hwparam.c @ 923:10b4bed10192

gsm-fw/L1: fix for the DSP patch corruption bug The L1 code we got from the LoCosto fw contains a feature for DSP CPU load measurement. This feature is a LoCosto-ism, i.e., not applicable to earlier DBB chips (Calypso) with their respective earlier DSP ROMs. Most of the code dealing with that feature is conditionalized as #if (DSP >= 38), but one spot was missed, and the MCU code was writing into an API word dealing with this feature. In TCS211 this DSP API word happens to be used by the DSP code patch, hence that write was corrupting the patched DSP code.
author Mychaela Falconia <falcon@ivan.Harhan.ORG>
date Mon, 19 Oct 2015 17:13:56 +0000
parents 1ed2d78f150c
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_device();

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_device},
	{"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);
}