[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 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)
{
	/* Do nothing for now, sysmon_reloc() is required by the sysmon post */
}

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	60
6aee00f5 SL	61	#define REG_TEMPERATURE 0x12BC
	62	#define REG_VOLTAGE_5V 0x12CA
	63	#define REG_VOLTAGE_5V_STANDBY 0x12C6
	64
	65	#define TEMPERATURE_MIN (-40) /* degr. C */
	66	#define TEMPERATURE_MAX (+90) /* degr. C */
	67	#define TEMPERATURE_DISPLAY_MIN (-35) /* degr. C */
6adf61dc	68	#define TEMPERATURE_DISPLAY_MAX (+85) /* degr. C */
6aee00f5 SL	69
	70	#define VOLTAGE_5V_MIN (+4500) /* mV */
	71	#define VOLTAGE_5V_MAX (+5500) /* mV */
	72
	73	#define VOLTAGE_5V_STANDBY_MIN (+3500) /* mV */
	74	#define VOLTAGE_5V_STANDBY_MAX (+5500) /* mV */
	75
65b20dce YT	76	typedef struct sysmon_s sysmon_t;
	77	typedef struct sysmon_table_s sysmon_table_t;
	78
	79	static void sysmon_dspic_init (sysmon_t * this);
	80	static int sysmon_dspic_read (sysmon_t * this, uint addr);
	81	static void sysmon_backlight_disable (sysmon_table_t * this);
65b20dce YT	82
	83	struct sysmon_s
	84	{
	85	uchar chip;
	86	void (init)(sysmon_t );
	87	int (read)(sysmon_t , uint);
	88	};
	89
	90	static sysmon_t sysmon_dspic =
6d0f6bcf	91	{CONFIG_SYS_I2C_DSPIC_IO_ADDR, sysmon_dspic_init, sysmon_dspic_read};
65b20dce YT	92
	93	static sysmon_t * sysmon_list[] =
	94	{
	95	&sysmon_dspic,
	96	NULL
	97	};
	98
	99	struct sysmon_table_s
	100	{
	101	char * name;
	102	char * unit_name;
	103	sysmon_t * sysmon;
	104	void (exec_before)(sysmon_table_t );
	105	void (exec_after)(sysmon_table_t );
	106
	107	int unit_precision;
	108	int unit_div;
	109	int unit_min;
	110	int unit_max;
	111	uint val_mask;
	112	uint val_min;
	113	uint val_max;
	114	int val_valid;
	115	uint val_min_alt;
	116	uint val_max_alt;
	117	int val_valid_alt;
	118	uint addr;
	119	};
	120
	121	static sysmon_table_t sysmon_table[] =
	122	{
6aee00f5 SL	123	{
	124	"Temperature", " C", &sysmon_dspic, NULL, sysmon_backlight_disable,
	125	1, 1, -32768, 32767, 0xFFFF,
	126	0x8000 + TEMPERATURE_MIN, 0x8000 + TEMPERATURE_MAX, 0,
	127	0x8000 + TEMPERATURE_DISPLAY_MIN, 0x8000 + TEMPERATURE_DISPLAY_MAX, 0,
ea6f6689	128	REG_TEMPERATURE,
6aee00f5 SL	129	},
	130
	131	{
	132	"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
e7419b24	133	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
58b575e5 SL	134	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
58b575e5 SL	135	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
ea6f6689	136	REG_VOLTAGE_5V,
6aee00f5 SL	137	},
	138
	139	{
	140	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
e7419b24	141	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
58b575e5 SL	142	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
58b575e5 SL	143	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
ea6f6689	144	REG_VOLTAGE_5V_STANDBY,
6aee00f5	145	},
65b20dce YT	146	};
	147	static int sysmon_table_size = sizeof(sysmon_table) / sizeof(sysmon_table[0]);
	148
	149	int sysmon_init_f (void)
	150	{
	151	sysmon_t ** l;
	152
	153	for (l = sysmon_list; *l; l++)
	154	(l)->init(l);
	155
	156	return 0;
	157	}
	158
	159	void sysmon_reloc (void)
	160	{
80f73b92	161	/* Do nothing for now, sysmon_reloc() is required by the sysmon post */
65b20dce YT	162	}
	163
	164	static char sysmon_unit_value (sysmon_table_t s, uint val)
	165	{
	166	static char buf[32];
	167	char *p, sign;
	168	int decimal, frac;
	169	int unit_val;
	170
7ed40117	171	unit_val = s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;
65b20dce YT	172
	173	if (val == -1)
	174	return "I/O ERROR";
	175
	176	if (unit_val < 0) {
	177	sign = '-';
	178	unit_val = -unit_val;
	179	} else
	180	sign = '+';
	181
	182	p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);
	183
	184
	185	frac = unit_val % s->unit_div;
	186
	187	frac /= (s->unit_div / s->unit_precision);
	188
	189	decimal = s->unit_precision;
	190
	191	if (decimal != 1)
	192	*p++ = '.';
	193	for (decimal /= 10; decimal != 0; decimal /= 10)
	194	*p++ = '0' + (frac / decimal) % 10;
	195	strcpy(p, s->unit_name);
	196
	197	return buf;
	198	}
	199
	200	static void sysmon_dspic_init (sysmon_t * this)
	201	{
	202	}
	203
	204	static int sysmon_dspic_read (sysmon_t * this, uint addr)
	205	{
	206	int res = dspic_read(addr);
	207
	208	/* To fit into the table range we should add 0x8000 */
	209	return (res == -1) ? -1 : (res + 0x8000);
	210	}
	211
	212	static void sysmon_backlight_disable (sysmon_table_t * this)
	213	{
0f855a1f YT	214	#if defined(CONFIG_VIDEO)
	215	board_backlight_switch(this->val_valid_alt);
	216	#endif
65b20dce YT	217	}
	218
	219	int sysmon_post_test (int flags)
	220	{
	221	int res = 0;
	222	sysmon_table_t * t;
	223	int val;
	224
	225	for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
	226	if (t->exec_before)
	227	t->exec_before(t);
	228
	229	val = t->sysmon->read(t->sysmon, t->addr);
	230	if (val != -1) {
	231	t->val_valid = val >= t->val_min && val <= t->val_max;
	232	t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
	233	} else {
	234	t->val_valid = 0;
	235	t->val_valid_alt = 0;
	236	}
	237
	238	if (t->exec_after)
	239	t->exec_after(t);
	240
	241	if ((!t->val_valid) \|\| (flags & POST_MANUAL)) {
	242	printf("%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
	243	printf("allowed range");
	244	printf(" %-8s ..", sysmon_unit_value(t, t->val_min));
	245	printf(" %-8s", sysmon_unit_value(t, t->val_max));
	246	printf(" %s\n", t->val_valid ? "OK" : "FAIL");
	247	}
	248
	249	if (!t->val_valid)
	250	res = 1;
	251	}
	252
	253	return res;
	254	}
6d0f6bcf	255	#endif /* CONFIG_POST & CONFIG_SYS_POST_SYSMON */