[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
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#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" environment 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, ushort *data);

#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, int *val);
static int sysmon_dspic_read_sgn(sysmon_t *this, uint addr,  int *val);
static void sysmon_backlight_disable(sysmon_table_t *this);

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

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

static sysmon_t sysmon_dspic_sgn = {
	CONFIG_SYS_I2C_DSPIC_IO_ADDR,
	sysmon_dspic_init,
	sysmon_dspic_read_sgn
};

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,
	},

	{
		"Temperature", "°C", &sysmon_dspic_sgn, 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,
	},
};

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 *val)
{
	ushort data;

	if (dspic_read(addr, &data) == 0){
		/* To fit into the table range we should add 0x8000 */
		*val = data + 0x8000;
		return 0;
	}

	return -1;
}

static int sysmon_dspic_read_sgn(sysmon_t *this, uint addr, int *val)
{
	ushort data;

	if (dspic_read(addr, &data) == 0){
		/* To fit into the table range we should add 0x8000 */
		*val = (signed short)data + 0x8000;
		return 0;
	}

	return -1;
}

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 + ARRAY_SIZE(sysmon_table); t++) {
		t->val_valid = 1;
		if (t->exec_before)
			t->exec_before(t);

		if (t->sysmon->read(t->sysmon, t->addr, &val) != 0) {
			t->val_valid = 0;
			t->val_valid_alt = 0;
			post_log(": read failed\n");
			res = 1;
			break;
		}

		if (t->val_valid != 0) {
			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;
		}

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

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

		if (!t->val_valid) {
			res = 1;
			break;
		}
	}
	post_log("\n");

	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	*
1a459660	6	* SPDX-License-Identifier: GPL-2.0+
65b20dce YT	7	*/
	8
	9	#include <post.h>
	10	#include <common.h>
	11
65b20dce YT	12	/*
	13	* SYSMON test
	14	*
	15	* This test performs the system hardware monitoring.
	16	* The test passes when all the following voltages and temperatures
	17	* are within allowed ranges:
	18	*
6aee00f5 SL	19	* Temperature -40 .. +90 C
	20	* +5V +4.50 .. +5.50 V
	21	* +5V standby +3.50 .. +5.50 V
65b20dce YT	22	*
	23	* LCD backlight is not enabled if temperature values are not within
	24	* allowed ranges (-30 .. + 80). The brightness of backlite can be
1bce2aeb	25	* controlled by setting "brightness" environment variable. Default value is 50%
65b20dce YT	26	*
	27	* See the list of all parameters in the sysmon_table below
	28	*/
	29
	30	#include <post.h>
	31	#include <watchdog.h>
	32	#include <i2c.h>
	33
0f855a1f YT	34	#if defined(CONFIG_VIDEO)
	35	#include <mb862xx.h>
	36	#endif
	37
6d0f6bcf	38	#if CONFIG_POST & CONFIG_SYS_POST_SYSMON
65b20dce YT	39
	40	DECLARE_GLOBAL_DATA_PTR;
	41
65b20dce	42	/* from dspic.c */
f14ae418	43	extern int dspic_read(ushort reg, ushort *data);
65b20dce	44
6aee00f5 SL	45	#define REG_TEMPERATURE 0x12BC
	46	#define REG_VOLTAGE_5V 0x12CA
	47	#define REG_VOLTAGE_5V_STANDBY 0x12C6
	48
	49	#define TEMPERATURE_MIN (-40) /* degr. C */
	50	#define TEMPERATURE_MAX (+90) /* degr. C */
	51	#define TEMPERATURE_DISPLAY_MIN (-35) /* degr. C */
6adf61dc	52	#define TEMPERATURE_DISPLAY_MAX (+85) /* degr. C */
6aee00f5 SL	53
	54	#define VOLTAGE_5V_MIN (+4500) /* mV */
	55	#define VOLTAGE_5V_MAX (+5500) /* mV */
	56
	57	#define VOLTAGE_5V_STANDBY_MIN (+3500) /* mV */
	58	#define VOLTAGE_5V_STANDBY_MAX (+5500) /* mV */
	59
65b20dce YT	60	typedef struct sysmon_s sysmon_t;
	61	typedef struct sysmon_table_s sysmon_table_t;
	62
f14ae418 SL	63	static void sysmon_dspic_init(sysmon_t *this);
	64	static int sysmon_dspic_read(sysmon_t this, uint addr, int val);
	65	static int sysmon_dspic_read_sgn(sysmon_t this, uint addr, int val);
	66	static void sysmon_backlight_disable(sysmon_table_t *this);
65b20dce	67
f14ae418	68	struct sysmon_s {
65b20dce YT	69	uchar chip;
65b20dce YT	70	void (init)(sysmon_t );
f14ae418	71	int (read)(sysmon_t , uint, int *);
65b20dce YT	72	};
65b20dce YT	73
f14ae418 SL	74	static sysmon_t sysmon_dspic = {
	75	CONFIG_SYS_I2C_DSPIC_IO_ADDR,
	76	sysmon_dspic_init,
	77	sysmon_dspic_read
	78	};
65b20dce	79
f14ae418 SL	80	static sysmon_t sysmon_dspic_sgn = {
	81	CONFIG_SYS_I2C_DSPIC_IO_ADDR,
	82	sysmon_dspic_init,
	83	sysmon_dspic_read_sgn
	84	};
	85
	86	static sysmon_t *sysmon_list[] = {
65b20dce YT	87	&sysmon_dspic,
	88	NULL
	89	};
	90
f14ae418 SL	91	struct sysmon_table_s {
	92	char *name;
	93	char *unit_name;
	94	sysmon_t *sysmon;
65b20dce YT	95	void (exec_before)(sysmon_table_t );
	96	void (exec_after)(sysmon_table_t );
	97
	98	int unit_precision;
	99	int unit_div;
	100	int unit_min;
	101	int unit_max;
	102	uint val_mask;
	103	uint val_min;
	104	uint val_max;
	105	int val_valid;
	106	uint val_min_alt;
	107	uint val_max_alt;
	108	int val_valid_alt;
	109	uint addr;
	110	};
	111
f14ae418	112	static sysmon_table_t sysmon_table[] = {
6aee00f5	113	{
f14ae418 SL	114	"Temperature", " C", &sysmon_dspic, NULL, sysmon_backlight_disable,
	115	1, 1, -32768, 32767, 0xFFFF,
	116	0x8000 + TEMPERATURE_MIN, 0x8000 + TEMPERATURE_MAX, 0,
	117	0x8000 + TEMPERATURE_DISPLAY_MIN, 0x8000 + TEMPERATURE_DISPLAY_MAX, 0,
	118	REG_TEMPERATURE,
6aee00f5 SL	119	},
	120
	121	{
f14ae418 SL	122	"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
	123	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	124	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
	125	0x8000 + VOLTAGE_5V_MIN, 0x8000 + VOLTAGE_5V_MAX, 0,
	126	REG_VOLTAGE_5V,
6aee00f5 SL	127	},
	128
	129	{
f14ae418 SL	130	"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
	131	100, 1000, -0x8000, 0x7FFF, 0xFFFF,
	132	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
	133	0x8000 + VOLTAGE_5V_STANDBY_MIN, 0x8000 + VOLTAGE_5V_STANDBY_MAX, 0,
	134	REG_VOLTAGE_5V_STANDBY,
	135	},
	136
	137	{
	138	"Temperature", "°C", &sysmon_dspic_sgn, NULL, sysmon_backlight_disable,
	139	1, 1, -32768, 32767, 0xFFFF,
	140	0x8000 + TEMPERATURE_MIN, 0x8000 + TEMPERATURE_MAX, 0,
	141	0x8000 + TEMPERATURE_DISPLAY_MIN, 0x8000 + TEMPERATURE_DISPLAY_MAX, 0,
	142	REG_TEMPERATURE,
6aee00f5	143	},
65b20dce	144	};
65b20dce	145
f14ae418	146	int sysmon_init_f(void)
65b20dce	147	{
f14ae418	148	sysmon_t **l;
65b20dce YT	149
	150	for (l = sysmon_list; *l; l++)
	151	(l)->init(l);
	152
	153	return 0;
	154	}
	155
f14ae418	156	void sysmon_reloc(void)
65b20dce	157	{
80f73b92	158	/* Do nothing for now, sysmon_reloc() is required by the sysmon post */
65b20dce YT	159	}
65b20dce YT	160
f14ae418	161	static char sysmon_unit_value(sysmon_table_t s, uint val)
65b20dce YT	162	{
	163	static char buf[32];
	164	char *p, sign;
	165	int decimal, frac;
	166	int unit_val;
	167
7ed40117	168	unit_val = s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;
65b20dce YT	169
	170	if (val == -1)
	171	return "I/O ERROR";
	172
	173	if (unit_val < 0) {
	174	sign = '-';
	175	unit_val = -unit_val;
f14ae418	176	} else {
65b20dce	177	sign = '+';
f14ae418	178	}
65b20dce YT	179
	180	p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);
	181
65b20dce	182	frac = unit_val % s->unit_div;
65b20dce YT	183	frac /= (s->unit_div / s->unit_precision);
	184
	185	decimal = s->unit_precision;
	186
	187	if (decimal != 1)
	188	*p++ = '.';
	189	for (decimal /= 10; decimal != 0; decimal /= 10)
	190	*p++ = '0' + (frac / decimal) % 10;
	191	strcpy(p, s->unit_name);
	192
	193	return buf;
	194	}
	195
f14ae418	196	static void sysmon_dspic_init(sysmon_t *this)
65b20dce YT	197	{
	198	}
	199
f14ae418	200	static int sysmon_dspic_read(sysmon_t this, uint addr, int val)
65b20dce	201	{
f14ae418 SL	202	ushort data;
	203
	204	if (dspic_read(addr, &data) == 0){
	205	/* To fit into the table range we should add 0x8000 */
	206	*val = data + 0x8000;
	207	return 0;
	208	}
65b20dce	209
f14ae418	210	return -1;
65b20dce YT	211	}
65b20dce YT	212
f14ae418 SL	213	static int sysmon_dspic_read_sgn(sysmon_t this, uint addr, int val)
	214	{
	215	ushort data;
	216
	217	if (dspic_read(addr, &data) == 0){
	218	/* To fit into the table range we should add 0x8000 */
	219	*val = (signed short)data + 0x8000;
	220	return 0;
	221	}
	222
	223	return -1;
	224	}
	225
	226	static void sysmon_backlight_disable(sysmon_table_t *this)
65b20dce	227	{
0f855a1f YT	228	#if defined(CONFIG_VIDEO)
	229	board_backlight_switch(this->val_valid_alt);
	230	#endif
65b20dce YT	231	}
65b20dce YT	232
f14ae418	233	int sysmon_post_test(int flags)
65b20dce YT	234	{
	235	int res = 0;
	236	sysmon_table_t * t;
	237	int val;
	238
f14ae418 SL	239	for (t = sysmon_table; t < sysmon_table + ARRAY_SIZE(sysmon_table); t++) {
f14ae418 SL	240	t->val_valid = 1;
65b20dce YT	241	if (t->exec_before)
	242	t->exec_before(t);
	243
f14ae418	244	if (t->sysmon->read(t->sysmon, t->addr, &val) != 0) {
65b20dce YT	245	t->val_valid = 0;
65b20dce YT	246	t->val_valid_alt = 0;
f14ae418 SL	247	post_log(": read failed\n");
	248	res = 1;
	249	break;
	250	}
	251
	252	if (t->val_valid != 0) {
	253	t->val_valid = val >= t->val_min && val <= t->val_max;
	254	t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
65b20dce YT	255	}
	256
	257	if (t->exec_after)
	258	t->exec_after(t);
	259
f14ae418 SL	260	if ((!t->val_valid) \|\| (flags)) {
	261	post_log("\n\t%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
	262	post_log("allowed range");
	263	post_log(" %-8s ..", sysmon_unit_value(t, t->val_min));
	264	post_log(" %-8s", sysmon_unit_value(t, t->val_max));
	265	post_log(" %s", t->val_valid ? "OK" : "FAIL");
65b20dce YT	266	}
65b20dce YT	267
f14ae418	268	if (!t->val_valid) {
65b20dce	269	res = 1;
f14ae418 SL	270	break;
f14ae418 SL	271	}
65b20dce	272	}
f14ae418	273	post_log("\n");
65b20dce YT	274
	275	return res;
	276	}
6d0f6bcf	277	#endif /* CONFIG_POST & CONFIG_SYS_POST_SYSMON */