Merge branch 'master' of /home/wd/git/u-boot/lwmon5
[platform/kernel/u-boot.git] / post / board / lwmon5 / sysmon.c
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
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  *
35  * Temperature                -40 .. +85 C
36  * +5V                      +4.75 .. +5.25 V
37  * +5V standby              +4.75 .. +5.25 V
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
50 #if defined(CONFIG_VIDEO)
51 #include <mb862xx.h>
52 #endif
53
54 #if CONFIG_POST & CFG_POST_SYSMON
55
56 DECLARE_GLOBAL_DATA_PTR;
57
58 /* from dspic.c */
59 extern int dspic_read(ushort reg);
60
61 #define RELOC(x) if (x != NULL) x = (void *) ((ulong) (x) + gd->reloc_off)
62
63 typedef struct sysmon_s sysmon_t;
64 typedef struct sysmon_table_s sysmon_table_t;
65
66 static void sysmon_dspic_init (sysmon_t * this);
67 static int sysmon_dspic_read (sysmon_t * this, uint addr);
68 static void sysmon_backlight_disable (sysmon_table_t * this);
69
70 struct sysmon_s
71 {
72         uchar   chip;
73         void    (*init)(sysmon_t *);
74         int     (*read)(sysmon_t *, uint);
75 };
76
77 static sysmon_t sysmon_dspic =
78         {CFG_I2C_DSPIC_IO_ADDR, sysmon_dspic_init, sysmon_dspic_read};
79
80 static sysmon_t * sysmon_list[] =
81 {
82         &sysmon_dspic,
83         NULL
84 };
85
86 struct sysmon_table_s
87 {
88         char *          name;
89         char *          unit_name;
90         sysmon_t *      sysmon;
91         void            (*exec_before)(sysmon_table_t *);
92         void            (*exec_after)(sysmon_table_t *);
93
94         int             unit_precision;
95         int             unit_div;
96         int             unit_min;
97         int             unit_max;
98         uint            val_mask;
99         uint            val_min;
100         uint            val_max;
101         int             val_valid;
102         uint            val_min_alt;
103         uint            val_max_alt;
104         int             val_valid_alt;
105         uint            addr;
106 };
107
108 static sysmon_table_t sysmon_table[] =
109 {
110     {"Temperature", " C", &sysmon_dspic, NULL, sysmon_backlight_disable,
111      1, 1, -32768, 32767, 0xFFFF, 0x8000-40, 0x8000+85, 0,
112                                   0x8000-30, 0x8000+80, 0, 0x12BC},
113
114     {"+ 5 V", "V", &sysmon_dspic, NULL, NULL,
115      100, 1000, -0x8000, 0x7FFF, 0xFFFF, 0x8000+4750, 0x8000+5250, 0,
116                                          0x8000+4750, 0x8000+5250, 0, 0x12CA},
117
118     {"+ 5 V standby", "V", &sysmon_dspic, NULL, NULL,
119      100, 1000, -0x8000, 0x7FFF, 0xFFFF, 0x8000+4750, 0x8000+5250, 0,
120                                          0x8000+4750, 0x8000+5250, 0, 0x12C6},
121 };
122 static int sysmon_table_size = sizeof(sysmon_table) / sizeof(sysmon_table[0]);
123
124 int sysmon_init_f (void)
125 {
126         sysmon_t ** l;
127
128         for (l = sysmon_list; *l; l++)
129                 (*l)->init(*l);
130
131         return 0;
132 }
133
134 void sysmon_reloc (void)
135 {
136         sysmon_t ** l;
137         sysmon_table_t * t;
138
139         for (l = sysmon_list; *l; l++) {
140                 RELOC(*l);
141                 RELOC((*l)->init);
142                 RELOC((*l)->read);
143         }
144
145         for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
146                 RELOC(t->exec_before);
147                 RELOC(t->exec_after);
148                 RELOC(t->sysmon);
149         }
150 }
151
152 static char *sysmon_unit_value (sysmon_table_t *s, uint val)
153 {
154         static char buf[32];
155         char *p, sign;
156         int decimal, frac;
157         int unit_val;
158
159         unit_val =
160             s->unit_min + (s->unit_max - s->unit_min) * val / s->val_mask;
161
162         if (val == -1)
163                 return "I/O ERROR";
164
165         if (unit_val < 0) {
166                 sign = '-';
167                 unit_val = -unit_val;
168         } else
169                 sign = '+';
170
171         p = buf + sprintf(buf, "%c%2d", sign, unit_val / s->unit_div);
172
173
174         frac = unit_val % s->unit_div;
175
176         frac /= (s->unit_div / s->unit_precision);
177
178         decimal = s->unit_precision;
179
180         if (decimal != 1)
181                 *p++ = '.';
182         for (decimal /= 10; decimal != 0; decimal /= 10)
183                 *p++ = '0' + (frac / decimal) % 10;
184         strcpy(p, s->unit_name);
185
186         return buf;
187 }
188
189 static void sysmon_dspic_init (sysmon_t * this)
190 {
191 }
192
193 static int sysmon_dspic_read (sysmon_t * this, uint addr)
194 {
195         int res = dspic_read(addr);
196
197         /* To fit into the table range we should add 0x8000 */
198         return (res == -1) ? -1 : (res + 0x8000);
199 }
200
201 static void sysmon_backlight_disable (sysmon_table_t * this)
202 {
203 #if defined(CONFIG_VIDEO)
204         board_backlight_switch(this->val_valid_alt);
205 #endif
206 }
207
208 int sysmon_post_test (int flags)
209 {
210         int res = 0;
211         sysmon_table_t * t;
212         int val;
213
214         for (t = sysmon_table; t < sysmon_table + sysmon_table_size; t ++) {
215                 if (t->exec_before)
216                         t->exec_before(t);
217
218                 val = t->sysmon->read(t->sysmon, t->addr);
219                 if (val != -1) {
220                         t->val_valid = val >= t->val_min && val <= t->val_max;
221                         t->val_valid_alt = val >= t->val_min_alt && val <= t->val_max_alt;
222                 } else {
223                         t->val_valid = 0;
224                         t->val_valid_alt = 0;
225                 }
226
227                 if (t->exec_after)
228                         t->exec_after(t);
229
230                 if ((!t->val_valid) || (flags & POST_MANUAL)) {
231                         printf("%-17s = %-10s ", t->name, sysmon_unit_value(t, val));
232                         printf("allowed range");
233                         printf(" %-8s ..", sysmon_unit_value(t, t->val_min));
234                         printf(" %-8s", sysmon_unit_value(t, t->val_max));
235                         printf("     %s\n", t->val_valid ? "OK" : "FAIL");
236                 }
237
238                 if (!t->val_valid)
239                         res = 1;
240         }
241
242         return res;
243 }
244
245 #endif /* CONFIG_POST & CFG_POST_SYSMON */