[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 & CONFIG_SYS_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 =
	{CONFIG_SYS_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,
	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
	REG_VOLTAGE_5V,
	},

	{
	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + 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 & CONFIG_SYS_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
6d0f6bcf	54	#if CONFIG_POST & CONFIG_SYS_POST_SYSMON
65b20dce YT	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 */
6adf61dc	70	#define TEMPERATURE_DISPLAY_MAX (+85) /* degr. C */
6aee00f5 SL	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 =
6d0f6bcf	93	{CONFIG_SYS_I2C_DSPIC_IO_ADDR, sysmon_dspic_init, sysmon_dspic_read};
65b20dce YT	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,
ea6f6689	130	REG_TEMPERATURE,
6aee00f5 SL	131	},
	132
	133	{
	134	"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
e7419b24	135	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
58b575e5 SL	136	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
58b575e5 SL	137	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
ea6f6689	138	REG_VOLTAGE_5V,
6aee00f5 SL	139	},
	140
	141	{
	142	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
e7419b24	143	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
58b575e5 SL	144	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
58b575e5 SL	145	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
ea6f6689	146	REG_VOLTAGE_5V_STANDBY,
6aee00f5	147	},
65b20dce YT	148	};
	149	static int sysmon_table_size = sizeof(sysmon_table) / sizeof(sysmon_table[0]);
	150
	151	int sysmon_init_f (void)
	152	{
	153	sysmon_t ** l;
	154
	155	for (l = sysmon_list; *l; l++)
	156	(l)->init(l);
	157
	158	return 0;
	159	}
	160
	161	void sysmon_reloc (void)
	162	{
	163	sysmon_t ** l;
	164	sysmon_table_t * t;
	165
	166	for (l = sysmon_list; *l; l++) {
	167	RELOC(*l);
	168	RELOC((*l)->init);
	169	RELOC((*l)->read);
	170	}
	171
	172	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
	173	RELOC(t->exec_before);
	174	RELOC(t->exec_after);
	175	RELOC(t->sysmon);
	176	}
	177	}
	178
	179	static char sysmon_unit_value (sysmon_table_t s, uint val)
	180	{
	181	static char buf[32];
	182	char *p, sign;
	183	int decimal, frac;
	184	int unit_val;
	185
7ed40117	186	unit_val = s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;
65b20dce YT	187
	188	if (val == -1)
	189	return "I/O ERROR";
	190
	191	if (unit_val < 0) {
	192	sign = '-';
	193	unit_val = -unit_val;
	194	} else
	195	sign = '+';
	196
	197	p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);
	198
	199
	200	frac = unit_val % s->unit_div;
	201
	202	frac /= (s->unit_div / s->unit_precision);
	203
	204	decimal = s->unit_precision;
	205
	206	if (decimal != 1)
	207	*p++ = '.';
	208	for (decimal /= 10; decimal != 0; decimal /= 10)
	209	*p++ = '0' + (frac / decimal) % 10;
	210	strcpy(p, s->unit_name);
	211
	212	return buf;
	213	}
	214
	215	static void sysmon_dspic_init (sysmon_t * this)
	216	{
	217	}
	218
	219	static int sysmon_dspic_read (sysmon_t * this, uint addr)
	220	{
	221	int res = dspic_read(addr);
	222
	223	/* To fit into the table range we should add 0x8000 */
	224	return (res == -1) ? -1 : (res + 0x8000);
	225	}
	226
	227	static void sysmon_backlight_disable (sysmon_table_t * this)
	228	{
0f855a1f YT	229	#if defined(CONFIG_VIDEO)
	230	board_backlight_switch(this->val_valid_alt);
	231	#endif
65b20dce YT	232	}
	233
	234	int sysmon_post_test (int flags)
	235	{
	236	int res = 0;
	237	sysmon_table_t * t;
	238	int val;
	239
	240	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
	241	if (t->exec_before)
	242	t->exec_before(t);
	243
	244	val = t->sysmon->read(t->sysmon, t->addr);
	245	if (val != -1) {
	246	t->val_valid = val >= t->val_min && val <= t->val_max;
	247	t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
	248	} else {
	249	t->val_valid = 0;
	250	t->val_valid_alt = 0;
	251	}
	252
	253	if (t->exec_after)
	254	t->exec_after(t);
	255
	256	if ((!t->val_valid) \|\| (flags & POST_MANUAL)) {
	257	printf("%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
	258	printf("allowed range");
	259	printf(" %-8s ..", sysmon_unit_value(t, t->val_min));
	260	printf(" %-8s", sysmon_unit_value(t, t->val_max));
	261	printf(" %s\n", t->val_valid ? "OK" : "FAIL");
	262	}
	263
	264	if (!t->val_valid)
	265	res = 1;
	266	}
	267
	268	return res;
	269	}
6d0f6bcf	270	#endif /* CONFIG_POST & CONFIG_SYS_POST_SYSMON */