[people/ms/u-boot.git] / post / board / lwmon5 / sysmon.c

/*
 * (C) Copyright 2008 Dmitry Rakhchev, EmCraft Systems, rda@emcraft.com
 *
 * Developed for DENX Software Engineering GmbH
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#include <post.h>
#include <common.h>

/*
 * SYSMON test
 *
 * This test performs the system hardware monitoring.
 * The test passes when all the following voltages and temperatures
 * are within allowed ranges:
 *
 * Temperature		  -40 .. +90 C
 * +5V			+4.50 .. +5.50 V
 * +5V standby		+3.50 .. +5.50 V
 *
 * LCD backlight is not enabled if temperature values are not within
 * allowed ranges (-30 .. + 80). The brightness of backlite can be
 * controlled by setting "brightness" enviroment variable. Default value is 50%
 *
 * See the list of all parameters in the sysmon_table below
 */

#include <post.h>
#include <watchdog.h>
#include <i2c.h>

#if defined(CONFIG_VIDEO)
#include <mb862xx.h>
#endif

#if CONFIG_POST & CFG_POST_SYSMON

DECLARE_GLOBAL_DATA_PTR;

/* from dspic.c */
extern int dspic_read(ushort reg);

#define	RELOC(x) if (x != NULL) x = (void *) ((ulong) (x) + gd->reloc_off)

#define REG_TEMPERATURE			0x12BC
#define REG_VOLTAGE_5V			0x12CA
#define REG_VOLTAGE_5V_STANDBY		0x12C6

#define TEMPERATURE_MIN			(-40)	/* degr. C */
#define TEMPERATURE_MAX			(+90)	/* degr. C */
#define TEMPERATURE_DISPLAY_MIN		(-35)	/* degr. C */
#define TEMPERATURE_DISPLAY_MAX		(+85)	/* degr. C */  

#define VOLTAGE_5V_MIN			(+4500)	/* mV */
#define VOLTAGE_5V_MAX			(+5500)	/* mV */

#define VOLTAGE_5V_STANDBY_MIN		(+3500)	/* mV */
#define VOLTAGE_5V_STANDBY_MAX		(+5500)	/* mV */

typedef struct sysmon_s sysmon_t;
typedef struct sysmon_table_s sysmon_table_t;

static void sysmon_dspic_init (sysmon_t * this);
static int sysmon_dspic_read (sysmon_t * this, uint addr);
static void sysmon_backlight_disable (sysmon_table_t * this);

struct sysmon_s
{
	uchar	chip;
	void	(*init)(sysmon_t *);
	int	(*read)(sysmon_t *, uint);
};

static sysmon_t sysmon_dspic =
	{CFG_I2C_DSPIC_IO_ADDR, sysmon_dspic_init, sysmon_dspic_read};

static sysmon_t * sysmon_list[] =
{
	&sysmon_dspic,
	NULL
};

struct sysmon_table_s
{
	char *		name;
	char *		unit_name;
	sysmon_t *	sysmon;
	void		(*exec_before)(sysmon_table_t *);
	void		(*exec_after)(sysmon_table_t *);

	int		unit_precision;
	int		unit_div;
	int		unit_min;
	int		unit_max;
	uint		val_mask;
	uint		val_min;
	uint		val_max;
	int		val_valid;
	uint		val_min_alt;
	uint		val_max_alt;
	int		val_valid_alt;
	uint		addr;
};

static sysmon_table_t sysmon_table[] =
{
	{
	"Temperature", " C", &sysmon_dspic, NULL, sysmon_backlight_disable,
	1, 1, -32768, 32767, 0xFFFF,
	0x8000 + TEMPERATURE_MIN,	  0x8000 + TEMPERATURE_MAX,	    0,
	0x8000 + TEMPERATURE_DISPLAY_MIN, 0x8000 + TEMPERATURE_DISPLAY_MAX, 0,
	REG_TEMPERATURE
	},

	{
	"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	100, 1000, 0, 0xFFFF, 0xFFFF,
	VOLTAGE_5V_MIN, VOLTAGE_5V_MAX, 0,
	VOLTAGE_5V_MIN, VOLTAGE_5V_MAX, 0,
	REG_VOLTAGE_5V
	},

	{
	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	100, 1000, 0, 0xFFFF, 0xFFFF,
	VOLTAGE_5V_STANDBY_MIN, VOLTAGE_5V_STANDBY_MAX, 0,
	VOLTAGE_5V_STANDBY_MIN, VOLTAGE_5V_STANDBY_MAX, 0,
	REG_VOLTAGE_5V_STANDBY
	},
};
static int sysmon_table_size = sizeof(sysmon_table) / sizeof(sysmon_table[0]);

int sysmon_init_f (void)
{
	sysmon_t ** l;

	for (l = sysmon_list; *l; l++)
		(*l)->init(*l);

	return 0;
}

void sysmon_reloc (void)
{
	sysmon_t ** l;
	sysmon_table_t * t;

	for (l = sysmon_list; *l; l++) {
		RELOC(*l);
		RELOC((*l)->init);
		RELOC((*l)->read);
	}

	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
		RELOC(t->exec_before);
		RELOC(t->exec_after);
		RELOC(t->sysmon);
	}
}

static char *sysmon_unit_value (sysmon_table_t *s, uint val)
{
	static char buf[32];
	char *p, sign;
	int decimal, frac;
	int unit_val;

	unit_val = s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;

	if (val == -1)
		return "I/O ERROR";

	if (unit_val < 0) {
		sign = '-';
		unit_val = -unit_val;
	} else
		sign = '+';

	p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);


	frac = unit_val % s->unit_div;

	frac /= (s->unit_div / s->unit_precision);

	decimal = s->unit_precision;

	if (decimal != 1)
		*p++ = '.';
	for (decimal /= 10; decimal != 0; decimal /= 10)
		*p++ = '0' + (frac / decimal) % 10;
	strcpy(p, s->unit_name);

	return buf;
}

static void sysmon_dspic_init (sysmon_t * this)
{
}

static int sysmon_dspic_read (sysmon_t * this, uint addr)
{
	int res = dspic_read(addr);

	/* To fit into the table range we should add 0x8000 */
	return (res == -1) ? -1 : (res + 0x8000);
}

static void sysmon_backlight_disable (sysmon_table_t * this)
{
#if defined(CONFIG_VIDEO)
	board_backlight_switch(this->val_valid_alt);
#endif
}

int sysmon_post_test (int flags)
{
	int res = 0;
	sysmon_table_t * t;
	int val;

	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
		if (t->exec_before)
			t->exec_before(t);

		val = t->sysmon->read(t->sysmon, t->addr);
		if (val != -1) {
			t->val_valid = val >= t->val_min && val <= t->val_max;
			t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
		} else {
			t->val_valid = 0;
			t->val_valid_alt = 0;
		}

		if (t->exec_after)
			t->exec_after(t);

		if ((!t->val_valid) || (flags & POST_MANUAL)) {
			printf("%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
			printf("allowed range");
			printf(" %-8s ..", sysmon_unit_value(t, t->val_min));
			printf(" %-8s", sysmon_unit_value(t, t->val_max));
			printf("     %s\n", t->val_valid ? "OK" : "FAIL");
		}

		if (!t->val_valid)
			res = 1;
	}

	return res;
}
#endif /* CONFIG_POST & CFG_POST_SYSMON */
Commit	Line	Data
65b20dce YT	1	/*
	2	* (C) Copyright 2008 Dmitry Rakhchev, EmCraft Systems, rda@emcraft.com
	3	*
	4	* Developed for DENX Software Engineering GmbH
	5	*
	6	* See file CREDITS for list of people who contributed to this
	7	* project.
	8	*
	9	* This program is free software; you can redistribute it and/or
	10	* modify it under the terms of the GNU General Public License as
	11	* published by the Free Software Foundation; either version 2 of
	12	* the License, or (at your option) any later version.
	13	*
	14	* This program is distributed in the hope that it will be useful,
	15	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	* GNU General Public License for more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	22	* MA 02111-1307 USA
	23	*/
	24
	25	#include <post.h>
	26	#include <common.h>
	27
65b20dce YT	28	/*
	29	* SYSMON test
	30	*
	31	* This test performs the system hardware monitoring.
	32	* The test passes when all the following voltages and temperatures
	33	* are within allowed ranges:
	34	*
6aee00f5 SL	35	* Temperature -40 .. +90 C
	36	* +5V +4.50 .. +5.50 V
	37	* +5V standby +3.50 .. +5.50 V
65b20dce YT	38	*
	39	* LCD backlight is not enabled if temperature values are not within
	40	* allowed ranges (-30 .. + 80). The brightness of backlite can be
	41	* controlled by setting "brightness" enviroment variable. Default value is 50%
	42	*
	43	* See the list of all parameters in the sysmon_table below
	44	*/
	45
	46	#include <post.h>
	47	#include <watchdog.h>
	48	#include <i2c.h>
	49
0f855a1f YT	50	#if defined(CONFIG_VIDEO)
	51	#include <mb862xx.h>
	52	#endif
	53
65b20dce YT	54	#if CONFIG_POST & CFG_POST_SYSMON
	55
	56	DECLARE_GLOBAL_DATA_PTR;
	57
65b20dce YT	58	/* from dspic.c */
65b20dce YT	59	extern int dspic_read(ushort reg);
65b20dce YT	60
	61	#define RELOC(x) if (x != NULL) x = (void *) ((ulong) (x) + gd->reloc_off)
	62
6aee00f5 SL	63	#define REG_TEMPERATURE 0x12BC
	64	#define REG_VOLTAGE_5V 0x12CA
	65	#define REG_VOLTAGE_5V_STANDBY 0x12C6
	66
	67	#define TEMPERATURE_MIN (-40) /* degr. C */
	68	#define TEMPERATURE_MAX (+90) /* degr. C */
	69	#define TEMPERATURE_DISPLAY_MIN (-35) /* degr. C */
	70	#define TEMPERATURE_DISPLAY_MAX (+85) /* degr. C */
	71
	72	#define VOLTAGE_5V_MIN (+4500) /* mV */
	73	#define VOLTAGE_5V_MAX (+5500) /* mV */
	74
	75	#define VOLTAGE_5V_STANDBY_MIN (+3500) /* mV */
	76	#define VOLTAGE_5V_STANDBY_MAX (+5500) /* mV */
	77
65b20dce YT	78	typedef struct sysmon_s sysmon_t;
	79	typedef struct sysmon_table_s sysmon_table_t;
	80
	81	static void sysmon_dspic_init (sysmon_t * this);
	82	static int sysmon_dspic_read (sysmon_t * this, uint addr);
	83	static void sysmon_backlight_disable (sysmon_table_t * this);
65b20dce YT	84
	85	struct sysmon_s
	86	{
	87	uchar chip;
	88	void (init)(sysmon_t );
	89	int (read)(sysmon_t , uint);
	90	};
	91
	92	static sysmon_t sysmon_dspic =
	93	{CFG_I2C_DSPIC_IO_ADDR, sysmon_dspic_init, sysmon_dspic_read};
	94
	95	static sysmon_t * sysmon_list[] =
	96	{
	97	&sysmon_dspic,
	98	NULL
	99	};
	100
	101	struct sysmon_table_s
	102	{
	103	char * name;
	104	char * unit_name;
	105	sysmon_t * sysmon;
	106	void (exec_before)(sysmon_table_t );
	107	void (exec_after)(sysmon_table_t );
	108
	109	int unit_precision;
	110	int unit_div;
	111	int unit_min;
	112	int unit_max;
	113	uint val_mask;
	114	uint val_min;
	115	uint val_max;
	116	int val_valid;
	117	uint val_min_alt;
	118	uint val_max_alt;
	119	int val_valid_alt;
	120	uint addr;
	121	};
	122
	123	static sysmon_table_t sysmon_table[] =
	124	{
6aee00f5 SL	125	{
	126	"Temperature", " C", &sysmon_dspic, NULL, sysmon_backlight_disable,
	127	1, 1, -32768, 32767, 0xFFFF,
	128	0x8000 + TEMPERATURE_MIN, 0x8000 + TEMPERATURE_MAX, 0,
	129	0x8000 + TEMPERATURE_DISPLAY_MIN, 0x8000 + TEMPERATURE_DISPLAY_MAX, 0,
	130	REG_TEMPERATURE
	131	},
	132
	133	{
	134	"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
	135	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	136	100, 1000, 0, 0xFFFF, 0xFFFF,
	137	VOLTAGE_5V_MIN, VOLTAGE_5V_MAX, 0,
	138	VOLTAGE_5V_MIN, VOLTAGE_5V_MAX, 0,
	139	REG_VOLTAGE_5V
	140	},
	141
	142	{
	143	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
	144	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	145	100, 1000, 0, 0xFFFF, 0xFFFF,
	146	VOLTAGE_5V_STANDBY_MIN, VOLTAGE_5V_STANDBY_MAX, 0,
	147	VOLTAGE_5V_STANDBY_MIN, VOLTAGE_5V_STANDBY_MAX, 0,
	148	REG_VOLTAGE_5V_STANDBY
	149	},
65b20dce YT	150	};
	151	static int sysmon_table_size = sizeof(sysmon_table) / sizeof(sysmon_table[0]);
	152
	153	int sysmon_init_f (void)
	154	{
	155	sysmon_t ** l;
	156
	157	for (l = sysmon_list; *l; l++)
	158	(l)->init(l);
	159
	160	return 0;
	161	}
	162
	163	void sysmon_reloc (void)
	164	{
	165	sysmon_t ** l;
	166	sysmon_table_t * t;
	167
	168	for (l = sysmon_list; *l; l++) {
	169	RELOC(*l);
	170	RELOC((*l)->init);
	171	RELOC((*l)->read);
	172	}
	173
	174	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
	175	RELOC(t->exec_before);
	176	RELOC(t->exec_after);
	177	RELOC(t->sysmon);
	178	}
	179	}
	180
	181	static char sysmon_unit_value (sysmon_table_t s, uint val)
	182	{
	183	static char buf[32];
	184	char *p, sign;
	185	int decimal, frac;
	186	int unit_val;
	187
7ed40117	188	unit_val = s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;
65b20dce YT	189
	190	if (val == -1)
	191	return "I/O ERROR";
	192
	193	if (unit_val < 0) {
	194	sign = '-';
	195	unit_val = -unit_val;
	196	} else
	197	sign = '+';
	198
	199	p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);
	200
	201
	202	frac = unit_val % s->unit_div;
	203
	204	frac /= (s->unit_div / s->unit_precision);
	205
	206	decimal = s->unit_precision;
	207
	208	if (decimal != 1)
	209	*p++ = '.';
	210	for (decimal /= 10; decimal != 0; decimal /= 10)
	211	*p++ = '0' + (frac / decimal) % 10;
	212	strcpy(p, s->unit_name);
	213
	214	return buf;
	215	}
	216
	217	static void sysmon_dspic_init (sysmon_t * this)
	218	{
	219	}
	220
	221	static int sysmon_dspic_read (sysmon_t * this, uint addr)
	222	{
	223	int res = dspic_read(addr);
	224
	225	/* To fit into the table range we should add 0x8000 */
	226	return (res == -1) ? -1 : (res + 0x8000);
	227	}
	228
	229	static void sysmon_backlight_disable (sysmon_table_t * this)
	230	{
0f855a1f YT	231	#if defined(CONFIG_VIDEO)
	232	board_backlight_switch(this->val_valid_alt);
	233	#endif
65b20dce YT	234	}
	235
	236	int sysmon_post_test (int flags)
	237	{
	238	int res = 0;
	239	sysmon_table_t * t;
	240	int val;
	241
	242	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
	243	if (t->exec_before)
	244	t->exec_before(t);
	245
	246	val = t->sysmon->read(t->sysmon, t->addr);
	247	if (val != -1) {
	248	t->val_valid = val >= t->val_min && val <= t->val_max;
	249	t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
	250	} else {
	251	t->val_valid = 0;
	252	t->val_valid_alt = 0;
	253	}
	254
	255	if (t->exec_after)
	256	t->exec_after(t);
	257
	258	if ((!t->val_valid) \|\| (flags & POST_MANUAL)) {
	259	printf("%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
	260	printf("allowed range");
	261	printf(" %-8s ..", sysmon_unit_value(t, t->val_min));
	262	printf(" %-8s", sysmon_unit_value(t, t->val_max));
	263	printf(" %s\n", t->val_valid ? "OK" : "FAIL");
	264	}
	265
	266	if (!t->val_valid)
	267	res = 1;
	268	}
	269
	270	return res;
	271	}
65b20dce	272	#endif /* CONFIG_POST & CFG_POST_SYSMON */