lom.c revision 1.13 1 /* $NetBSD: lom.c,v 1.13 2014/02/25 18:30:08 pooka Exp $ */
2 /* $OpenBSD: lom.c,v 1.21 2010/02/28 20:44:39 kettenis Exp $ */
3 /*
4 * Copyright (c) 2009 Mark Kettenis
5 *
6 * Permission to use, copy, modify, and distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 */
18
19 #include <sys/cdefs.h>
20 __KERNEL_RCSID(0, "$NetBSD: lom.c,v 1.13 2014/02/25 18:30:08 pooka Exp $");
21
22 #include <sys/param.h>
23 #include <sys/device.h>
24 #include <sys/kernel.h>
25 #include <sys/proc.h>
26 #include <sys/envsys.h>
27 #include <sys/systm.h>
28 #include <sys/callout.h>
29 #include <sys/sysctl.h>
30
31 #include <machine/autoconf.h>
32
33 #include <dev/ebus/ebusreg.h>
34 #include <dev/ebus/ebusvar.h>
35 #include <dev/sysmon/sysmonvar.h>
36
37 /*
38 * LOMlite is a so far unidentified microcontroller.
39 */
40 #define LOM1_STATUS 0x00 /* R */
41 #define LOM1_STATUS_BUSY 0x80
42 #define LOM1_CMD 0x00 /* W */
43 #define LOM1_DATA 0x01 /* R/W */
44
45 /*
46 * LOMlite2 is implemented as a H8/3437 microcontroller which has its
47 * on-chip host interface hooked up to EBus.
48 */
49 #define LOM2_DATA 0x00 /* R/W */
50 #define LOM2_CMD 0x01 /* W */
51 #define LOM2_STATUS 0x01 /* R */
52 #define LOM2_STATUS_OBF 0x01 /* Output Buffer Full */
53 #define LOM2_STATUS_IBF 0x02 /* Input Buffer Full */
54
55 #define LOM_IDX_CMD 0x00
56 #define LOM_IDX_CMD_GENERIC 0x00
57 #define LOM_IDX_CMD_TEMP 0x04
58 #define LOM_IDX_CMD_FAN 0x05
59
60 #define LOM_IDX_FW_REV 0x01 /* Firmware revision */
61
62 #define LOM_IDX_FAN1 0x04 /* Fan speed */
63 #define LOM_IDX_FAN2 0x05
64 #define LOM_IDX_FAN3 0x06
65 #define LOM_IDX_FAN4 0x07
66 #define LOM_IDX_PSU1 0x08 /* PSU status */
67 #define LOM_IDX_PSU2 0x09
68 #define LOM_IDX_PSU3 0x0a
69 #define LOM_PSU_INPUTA 0x01
70 #define LOM_PSU_INPUTB 0x02
71 #define LOM_PSU_OUTPUT 0x04
72 #define LOM_PSU_PRESENT 0x08
73 #define LOM_PSU_STANDBY 0x10
74
75 #define LOM_IDX_TEMP1 0x18 /* Temperature */
76 #define LOM_IDX_TEMP2 0x19
77 #define LOM_IDX_TEMP3 0x1a
78 #define LOM_IDX_TEMP4 0x1b
79 #define LOM_IDX_TEMP5 0x1c
80 #define LOM_IDX_TEMP6 0x1d
81 #define LOM_IDX_TEMP7 0x1e
82 #define LOM_IDX_TEMP8 0x1f
83
84 #define LOM_IDX_LED1 0x25
85
86 #define LOM_IDX_ALARM 0x30
87 #define LOM_ALARM_1 0x01
88 #define LOM_ALARM_2 0x02
89 #define LOM_ALARM_3 0x04
90 #define LOM_ALARM_FAULT 0xf0
91 #define LOM_IDX_WDOG_CTL 0x31
92 #define LOM_WDOG_ENABLE 0x01
93 #define LOM_WDOG_RESET 0x02
94 #define LOM_WDOG_AL3_WDOG 0x04
95 #define LOM_WDOG_AL3_FANPSU 0x08
96 #define LOM_IDX_WDOG_TIME 0x32
97 #define LOM_WDOG_TIME_MAX 126
98
99 #define LOM1_IDX_HOSTNAME1 0x33
100 #define LOM1_IDX_HOSTNAME2 0x34
101 #define LOM1_IDX_HOSTNAME3 0x35
102 #define LOM1_IDX_HOSTNAME4 0x36
103 #define LOM1_IDX_HOSTNAME5 0x37
104 #define LOM1_IDX_HOSTNAME6 0x38
105 #define LOM1_IDX_HOSTNAME7 0x39
106 #define LOM1_IDX_HOSTNAME8 0x3a
107 #define LOM1_IDX_HOSTNAME9 0x3b
108 #define LOM1_IDX_HOSTNAME10 0x3c
109 #define LOM1_IDX_HOSTNAME11 0x3d
110 #define LOM1_IDX_HOSTNAME12 0x3e
111
112 #define LOM2_IDX_HOSTNAMELEN 0x38
113 #define LOM2_IDX_HOSTNAME 0x39
114
115 #define LOM_IDX_CONFIG 0x5d
116 #define LOM_IDX_FAN1_CAL 0x5e
117 #define LOM_IDX_FAN2_CAL 0x5f
118 #define LOM_IDX_FAN3_CAL 0x60
119 #define LOM_IDX_FAN4_CAL 0x61
120 #define LOM_IDX_FAN1_LOW 0x62
121 #define LOM_IDX_FAN2_LOW 0x63
122 #define LOM_IDX_FAN3_LOW 0x64
123 #define LOM_IDX_FAN4_LOW 0x65
124
125 #define LOM_IDX_CONFIG2 0x66
126 #define LOM_IDX_CONFIG3 0x67
127
128 #define LOM_IDX_PROBE55 0x7e /* Always returns 0x55 */
129 #define LOM_IDX_PROBEAA 0x7f /* Always returns 0xaa */
130
131 #define LOM_IDX_WRITE 0x80
132
133 #define LOM_IDX4_TEMP_NAME_START 0x40
134 #define LOM_IDX4_TEMP_NAME_END 0xff
135
136 #define LOM_IDX5_FAN_NAME_START 0x40
137 #define LOM_IDX5_FAN_NAME_END 0xff
138
139 #define LOM_MAX_ALARM 4
140 #define LOM_MAX_FAN 4
141 #define LOM_MAX_PSU 3
142 #define LOM_MAX_TEMP 8
143
144 struct lom_cmd {
145 uint8_t lc_cmd;
146 uint8_t lc_data;
147
148 TAILQ_ENTRY(lom_cmd) lc_next;
149 };
150
151 struct lom_softc {
152 device_t sc_dev;
153 bus_space_tag_t sc_iot;
154 bus_space_handle_t sc_ioh;
155
156 int sc_type;
157 #define LOM_LOMLITE 0
158 #define LOM_LOMLITE2 2
159 int sc_space;
160
161 struct sysmon_envsys *sc_sme;
162 envsys_data_t sc_alarm[LOM_MAX_ALARM];
163 envsys_data_t sc_fan[LOM_MAX_FAN];
164 envsys_data_t sc_psu[LOM_MAX_PSU];
165 envsys_data_t sc_temp[LOM_MAX_TEMP];
166
167 int sc_num_alarm;
168 int sc_num_fan;
169 int sc_num_psu;
170 int sc_num_temp;
171
172 int32_t sc_sysctl_num[LOM_MAX_ALARM];
173
174 struct timeval sc_alarm_lastread;
175 uint8_t sc_alarm_lastval;
176 struct timeval sc_fan_lastread[LOM_MAX_FAN];
177 struct timeval sc_psu_lastread[LOM_MAX_PSU];
178 struct timeval sc_temp_lastread[LOM_MAX_TEMP];
179
180 uint8_t sc_fan_cal[LOM_MAX_FAN];
181 uint8_t sc_fan_low[LOM_MAX_FAN];
182
183 char sc_hostname[MAXHOSTNAMELEN];
184
185 struct sysmon_wdog sc_smw;
186 int sc_wdog_period;
187 uint8_t sc_wdog_ctl;
188 struct lom_cmd sc_wdog_pat;
189
190 TAILQ_HEAD(, lom_cmd) sc_queue;
191 kmutex_t sc_queue_mtx;
192 struct callout sc_state_to;
193 int sc_state;
194 #define LOM_STATE_IDLE 0
195 #define LOM_STATE_CMD 1
196 #define LOM_STATE_DATA 2
197 int sc_retry;
198 };
199
200 static int lom_match(device_t, cfdata_t, void *);
201 static void lom_attach(device_t, device_t, void *);
202
203 CFATTACH_DECL_NEW(lom, sizeof(struct lom_softc),
204 lom_match, lom_attach, NULL, NULL);
205
206 static int lom_read(struct lom_softc *, uint8_t, uint8_t *);
207 static int lom_write(struct lom_softc *, uint8_t, uint8_t);
208 static void lom_queue_cmd(struct lom_softc *, struct lom_cmd *);
209 static void lom_dequeue_cmd(struct lom_softc *, struct lom_cmd *);
210 static int lom1_read(struct lom_softc *, uint8_t, uint8_t *);
211 static int lom1_write(struct lom_softc *, uint8_t, uint8_t);
212 static int lom1_read_polled(struct lom_softc *, uint8_t, uint8_t *);
213 static int lom1_write_polled(struct lom_softc *, uint8_t, uint8_t);
214 static void lom1_queue_cmd(struct lom_softc *, struct lom_cmd *);
215 static void lom1_process_queue(void *);
216 static void lom1_process_queue_locked(struct lom_softc *);
217 static int lom2_read(struct lom_softc *, uint8_t, uint8_t *);
218 static int lom2_write(struct lom_softc *, uint8_t, uint8_t);
219 static int lom2_read_polled(struct lom_softc *, uint8_t, uint8_t *);
220 static int lom2_write_polled(struct lom_softc *, uint8_t, uint8_t);
221 static void lom2_queue_cmd(struct lom_softc *, struct lom_cmd *);
222 static int lom2_intr(void *);
223
224 static int lom_init_desc(struct lom_softc *);
225 static void lom_refresh(struct sysmon_envsys *, envsys_data_t *);
226 static void lom_refresh_alarm(struct lom_softc *, envsys_data_t *, uint32_t);
227 static void lom_refresh_fan(struct lom_softc *, envsys_data_t *, uint32_t);
228 static void lom_refresh_psu(struct lom_softc *, envsys_data_t *, uint32_t);
229 static void lom_refresh_temp(struct lom_softc *, envsys_data_t *, uint32_t);
230 static void lom1_write_hostname(struct lom_softc *);
231 static void lom2_write_hostname(struct lom_softc *);
232
233 static int lom_wdog_tickle(struct sysmon_wdog *);
234 static int lom_wdog_setmode(struct sysmon_wdog *);
235
236 static bool lom_shutdown(device_t, int);
237
238 SYSCTL_SETUP_PROTO(sysctl_lom_setup);
239 static int lom_sysctl_alarm(SYSCTLFN_PROTO);
240
241 static const char *nodename[LOM_MAX_ALARM] =
242 { "fault_led", "alarm1", "alarm2", "alarm3" };
243 #ifdef SYSCTL_INCLUDE_DESCR
244 static const char *nodedesc[LOM_MAX_ALARM] =
245 { "Fault LED status", "Alarm1 status", "Alarm2 status ", "Alarm3 status" };
246 #endif
247 static const struct timeval refresh_interval = { 1, 0 };
248
249 static int
250 lom_match(device_t parent, cfdata_t match, void *aux)
251 {
252 struct ebus_attach_args *ea = aux;
253
254 if (strcmp(ea->ea_name, "SUNW,lom") == 0 ||
255 strcmp(ea->ea_name, "SUNW,lomh") == 0)
256 return (1);
257
258 return (0);
259 }
260
261 static void
262 lom_attach(device_t parent, device_t self, void *aux)
263 {
264 struct lom_softc *sc = device_private(self);
265 struct ebus_attach_args *ea = aux;
266 uint8_t reg, fw_rev, config, config2, config3;
267 uint8_t cal, low;
268 int i;
269 const struct sysctlnode *node = NULL, *newnode;
270
271 if (strcmp(ea->ea_name, "SUNW,lomh") == 0) {
272 if (ea->ea_nintr < 1) {
273 aprint_error(": no interrupt\n");
274 return;
275 }
276 sc->sc_type = LOM_LOMLITE2;
277 }
278
279 sc->sc_dev = self;
280 sc->sc_iot = ea->ea_bustag;
281 if (bus_space_map(sc->sc_iot, EBUS_ADDR_FROM_REG(&ea->ea_reg[0]),
282 ea->ea_reg[0].size, 0, &sc->sc_ioh) != 0) {
283 aprint_error(": can't map register space\n");
284 return;
285 }
286
287 if (sc->sc_type < LOM_LOMLITE2) {
288 /* XXX Magic */
289 (void)bus_space_read_1(sc->sc_iot, sc->sc_ioh, 0);
290 bus_space_write_1(sc->sc_iot, sc->sc_ioh, 3, 0xca);
291 }
292
293 if (lom_read(sc, LOM_IDX_PROBE55, ®) || reg != 0x55 ||
294 lom_read(sc, LOM_IDX_PROBEAA, ®) || reg != 0xaa ||
295 lom_read(sc, LOM_IDX_FW_REV, &fw_rev) ||
296 lom_read(sc, LOM_IDX_CONFIG, &config))
297 {
298 aprint_error(": not responding\n");
299 return;
300 }
301
302 aprint_normal(": %s: %s rev %d.%d\n", ea->ea_name,
303 sc->sc_type < LOM_LOMLITE2 ? "LOMlite" : "LOMlite2",
304 fw_rev >> 4, fw_rev & 0x0f);
305
306 TAILQ_INIT(&sc->sc_queue);
307 mutex_init(&sc->sc_queue_mtx, MUTEX_DEFAULT, IPL_BIO);
308
309 config2 = config3 = 0;
310 if (sc->sc_type < LOM_LOMLITE2) {
311 /*
312 * LOMlite doesn't do interrupts so we limp along on
313 * timeouts.
314 */
315 callout_init(&sc->sc_state_to, 0);
316 callout_setfunc(&sc->sc_state_to, lom1_process_queue, sc);
317 } else {
318 lom_read(sc, LOM_IDX_CONFIG2, &config2);
319 lom_read(sc, LOM_IDX_CONFIG3, &config3);
320
321 bus_intr_establish(sc->sc_iot, ea->ea_intr[0],
322 IPL_BIO, lom2_intr, sc);
323 }
324
325 sc->sc_num_alarm = LOM_MAX_ALARM;
326 sc->sc_num_fan = min((config >> 5) & 0x7, LOM_MAX_FAN);
327 sc->sc_num_psu = min((config >> 3) & 0x3, LOM_MAX_PSU);
328 sc->sc_num_temp = min((config2 >> 4) & 0xf, LOM_MAX_TEMP);
329
330 aprint_verbose_dev(self, "%d fan(s), %d PSU(s), %d temp sensor(s)\n",
331 sc->sc_num_fan, sc->sc_num_psu, sc->sc_num_temp);
332
333 for (i = 0; i < sc->sc_num_fan; i++) {
334 if (lom_read(sc, LOM_IDX_FAN1_CAL + i, &cal) ||
335 lom_read(sc, LOM_IDX_FAN1_LOW + i, &low)) {
336 aprint_error_dev(self, "can't read fan information\n");
337 return;
338 }
339 sc->sc_fan_cal[i] = cal;
340 sc->sc_fan_low[i] = low;
341 }
342
343 /* Setup our sysctl subtree, hw.lomN */
344 sysctl_createv(NULL, 0, NULL, &node,
345 0, CTLTYPE_NODE, device_xname(self), NULL,
346 NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
347
348 /* Initialize sensor data. */
349 sc->sc_sme = sysmon_envsys_create();
350 for (i = 0; i < sc->sc_num_alarm; i++) {
351 sc->sc_alarm[i].units = ENVSYS_INDICATOR;
352 sc->sc_alarm[i].state = ENVSYS_SINVALID;
353 if (i == 0)
354 strlcpy(sc->sc_alarm[i].desc, "Fault LED",
355 sizeof(sc->sc_alarm[i].desc));
356 else
357 snprintf(sc->sc_alarm[i].desc,
358 sizeof(sc->sc_alarm[i].desc), "Alarm%d", i);
359 if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_alarm[i])) {
360 sysmon_envsys_destroy(sc->sc_sme);
361 aprint_error_dev(self, "can't attach alarm sensor\n");
362 return;
363 }
364 if (node != NULL) {
365 sysctl_createv(NULL, 0, NULL, &newnode,
366 CTLFLAG_READWRITE, CTLTYPE_INT, nodename[i],
367 SYSCTL_DESCR(nodedesc[i]),
368 lom_sysctl_alarm, 0, (void *)sc, 0,
369 CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL);
370 if (newnode != NULL)
371 sc->sc_sysctl_num[i] = newnode->sysctl_num;
372 else
373 sc->sc_sysctl_num[i] = 0;
374 }
375 }
376 for (i = 0; i < sc->sc_num_fan; i++) {
377 sc->sc_fan[i].units = ENVSYS_SFANRPM;
378 sc->sc_fan[i].state = ENVSYS_SINVALID;
379 snprintf(sc->sc_fan[i].desc, sizeof(sc->sc_fan[i].desc),
380 "fan%d", i + 1);
381 if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_fan[i])) {
382 sysmon_envsys_destroy(sc->sc_sme);
383 aprint_error_dev(self, "can't attach fan sensor\n");
384 return;
385 }
386 }
387 for (i = 0; i < sc->sc_num_psu; i++) {
388 sc->sc_psu[i].units = ENVSYS_INDICATOR;
389 sc->sc_psu[i].state = ENVSYS_SINVALID;
390 snprintf(sc->sc_psu[i].desc, sizeof(sc->sc_psu[i].desc),
391 "PSU%d", i + 1);
392 if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_psu[i])) {
393 sysmon_envsys_destroy(sc->sc_sme);
394 aprint_error_dev(self, "can't attach PSU sensor\n");
395 return;
396 }
397 }
398 for (i = 0; i < sc->sc_num_temp; i++) {
399 sc->sc_temp[i].units = ENVSYS_STEMP;
400 sc->sc_temp[i].state = ENVSYS_SINVALID;
401 snprintf(sc->sc_temp[i].desc, sizeof(sc->sc_temp[i].desc),
402 "temp%d", i + 1);
403 if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_temp[i])) {
404 sysmon_envsys_destroy(sc->sc_sme);
405 aprint_error_dev(self, "can't attach temp sensor\n");
406 return;
407 }
408 }
409 if (lom_init_desc(sc)) {
410 aprint_error_dev(self, "can't read sensor names\n");
411 sysmon_envsys_destroy(sc->sc_sme);
412 return;
413 }
414
415 sc->sc_sme->sme_name = device_xname(self);
416 sc->sc_sme->sme_cookie = sc;
417 sc->sc_sme->sme_refresh = lom_refresh;
418 if (sysmon_envsys_register(sc->sc_sme)) {
419 aprint_error_dev(self,
420 "unable to register envsys with sysmon\n");
421 sysmon_envsys_destroy(sc->sc_sme);
422 return;
423 }
424
425 /* Initialize watchdog. */
426 lom_write(sc, LOM_IDX_WDOG_TIME, LOM_WDOG_TIME_MAX);
427 lom_read(sc, LOM_IDX_WDOG_CTL, &sc->sc_wdog_ctl);
428 sc->sc_wdog_ctl &= ~(LOM_WDOG_ENABLE|LOM_WDOG_RESET);
429 lom_write(sc, LOM_IDX_WDOG_CTL, sc->sc_wdog_ctl);
430
431 sc->sc_wdog_period = LOM_WDOG_TIME_MAX;
432
433 sc->sc_smw.smw_name = device_xname(self);
434 sc->sc_smw.smw_cookie = sc;
435 sc->sc_smw.smw_setmode = lom_wdog_setmode;
436 sc->sc_smw.smw_tickle = lom_wdog_tickle;
437 sc->sc_smw.smw_period = sc->sc_wdog_period;
438 if (sysmon_wdog_register(&sc->sc_smw)) {
439 aprint_error_dev(self,
440 "unable to register wdog with sysmon\n");
441 return;
442 }
443
444 aprint_verbose_dev(self, "Watchdog timer configured.\n");
445
446 if (!pmf_device_register1(self, NULL, NULL, lom_shutdown))
447 aprint_error_dev(self, "unable to register power handler\n");
448 }
449
450 static int
451 lom_read(struct lom_softc *sc, uint8_t reg, uint8_t *val)
452 {
453 if (sc->sc_type < LOM_LOMLITE2)
454 return lom1_read(sc, reg, val);
455 else
456 return lom2_read(sc, reg, val);
457 }
458
459 static int
460 lom_write(struct lom_softc *sc, uint8_t reg, uint8_t val)
461 {
462 if (sc->sc_type < LOM_LOMLITE2)
463 return lom1_write(sc, reg, val);
464 else
465 return lom2_write(sc, reg, val);
466 }
467
468 static void
469 lom_queue_cmd(struct lom_softc *sc, struct lom_cmd *lc)
470 {
471 if (sc->sc_type < LOM_LOMLITE2)
472 return lom1_queue_cmd(sc, lc);
473 else
474 return lom2_queue_cmd(sc, lc);
475 }
476
477 static void
478 lom_dequeue_cmd(struct lom_softc *sc, struct lom_cmd *lc)
479 {
480 struct lom_cmd *lcp;
481
482 mutex_enter(&sc->sc_queue_mtx);
483 TAILQ_FOREACH(lcp, &sc->sc_queue, lc_next) {
484 if (lcp == lc) {
485 TAILQ_REMOVE(&sc->sc_queue, lc, lc_next);
486 break;
487 }
488 }
489 mutex_exit(&sc->sc_queue_mtx);
490 }
491
492 static int
493 lom1_read(struct lom_softc *sc, uint8_t reg, uint8_t *val)
494 {
495 struct lom_cmd lc;
496 int error;
497
498 if (cold)
499 return lom1_read_polled(sc, reg, val);
500
501 lc.lc_cmd = reg;
502 lc.lc_data = 0xff;
503 lom1_queue_cmd(sc, &lc);
504
505 error = tsleep(&lc, PZERO, "lomrd", hz);
506 if (error)
507 lom_dequeue_cmd(sc, &lc);
508
509 *val = lc.lc_data;
510
511 return (error);
512 }
513
514 static int
515 lom1_write(struct lom_softc *sc, uint8_t reg, uint8_t val)
516 {
517 struct lom_cmd lc;
518 int error;
519
520 if (cold)
521 return lom1_write_polled(sc, reg, val);
522
523 lc.lc_cmd = reg | LOM_IDX_WRITE;
524 lc.lc_data = val;
525 lom1_queue_cmd(sc, &lc);
526
527 error = tsleep(&lc, PZERO, "lomwr", 2 * hz);
528 if (error)
529 lom_dequeue_cmd(sc, &lc);
530
531 return (error);
532 }
533
534 static int
535 lom1_read_polled(struct lom_softc *sc, uint8_t reg, uint8_t *val)
536 {
537 uint8_t str;
538 int i;
539
540 /* Wait for input buffer to become available. */
541 for (i = 30; i > 0; i--) {
542 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_STATUS);
543 delay(1000);
544 if ((str & LOM1_STATUS_BUSY) == 0)
545 break;
546 }
547 if (i == 0)
548 return (ETIMEDOUT);
549
550 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_CMD, reg);
551
552 /* Wait until the microcontroller fills output buffer. */
553 for (i = 30; i > 0; i--) {
554 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_STATUS);
555 delay(1000);
556 if ((str & LOM1_STATUS_BUSY) == 0)
557 break;
558 }
559 if (i == 0)
560 return (ETIMEDOUT);
561
562 *val = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_DATA);
563 return (0);
564 }
565
566 static int
567 lom1_write_polled(struct lom_softc *sc, uint8_t reg, uint8_t val)
568 {
569 uint8_t str;
570 int i;
571
572 /* Wait for input buffer to become available. */
573 for (i = 30; i > 0; i--) {
574 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_STATUS);
575 delay(1000);
576 if ((str & LOM1_STATUS_BUSY) == 0)
577 break;
578 }
579 if (i == 0)
580 return (ETIMEDOUT);
581
582 reg |= LOM_IDX_WRITE;
583 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_CMD, reg);
584
585 /* Wait until the microcontroller fills output buffer. */
586 for (i = 30; i > 0; i--) {
587 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_STATUS);
588 delay(1000);
589 if ((str & LOM1_STATUS_BUSY) == 0)
590 break;
591 }
592 if (i == 0)
593 return (ETIMEDOUT);
594
595 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_DATA, val);
596
597 return (0);
598 }
599
600 static void
601 lom1_queue_cmd(struct lom_softc *sc, struct lom_cmd *lc)
602 {
603 mutex_enter(&sc->sc_queue_mtx);
604 TAILQ_INSERT_TAIL(&sc->sc_queue, lc, lc_next);
605 if (sc->sc_state == LOM_STATE_IDLE) {
606 sc->sc_state = LOM_STATE_CMD;
607 lom1_process_queue_locked(sc);
608 }
609 mutex_exit(&sc->sc_queue_mtx);
610 }
611
612 static void
613 lom1_process_queue(void *arg)
614 {
615 struct lom_softc *sc = arg;
616
617 mutex_enter(&sc->sc_queue_mtx);
618 lom1_process_queue_locked(sc);
619 mutex_exit(&sc->sc_queue_mtx);
620 }
621
622 static void
623 lom1_process_queue_locked(struct lom_softc *sc)
624 {
625 struct lom_cmd *lc;
626 uint8_t str;
627
628 lc = TAILQ_FIRST(&sc->sc_queue);
629 if (lc == NULL) {
630 sc->sc_state = LOM_STATE_IDLE;
631 return;
632 }
633
634 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_STATUS);
635 if (str & LOM1_STATUS_BUSY) {
636 if (sc->sc_retry++ < 30) {
637 callout_schedule(&sc->sc_state_to, mstohz(1));
638 return;
639 }
640
641 /*
642 * Looks like the microcontroller got wedged. Unwedge
643 * it by writing this magic value. Give it some time
644 * to recover.
645 */
646 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_DATA, 0xac);
647 callout_schedule(&sc->sc_state_to, mstohz(1000));
648 sc->sc_state = LOM_STATE_CMD;
649 return;
650 }
651
652 sc->sc_retry = 0;
653
654 if (sc->sc_state == LOM_STATE_CMD) {
655 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_CMD, lc->lc_cmd);
656 sc->sc_state = LOM_STATE_DATA;
657 callout_schedule(&sc->sc_state_to, mstohz(250));
658 return;
659 }
660
661 KASSERT(sc->sc_state == LOM_STATE_DATA);
662 if ((lc->lc_cmd & LOM_IDX_WRITE) == 0)
663 lc->lc_data = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM1_DATA);
664 else
665 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM1_DATA, lc->lc_data);
666
667 TAILQ_REMOVE(&sc->sc_queue, lc, lc_next);
668
669 wakeup(lc);
670
671 if (!TAILQ_EMPTY(&sc->sc_queue)) {
672 sc->sc_state = LOM_STATE_CMD;
673 callout_schedule(&sc->sc_state_to, mstohz(1));
674 return;
675 }
676
677 sc->sc_state = LOM_STATE_IDLE;
678 }
679
680 static int
681 lom2_read(struct lom_softc *sc, uint8_t reg, uint8_t *val)
682 {
683 struct lom_cmd lc;
684 int error;
685
686 if (cold)
687 return lom2_read_polled(sc, reg, val);
688
689 lc.lc_cmd = reg;
690 lc.lc_data = 0xff;
691 lom2_queue_cmd(sc, &lc);
692
693 error = tsleep(&lc, PZERO, "lom2rd", hz);
694 if (error)
695 lom_dequeue_cmd(sc, &lc);
696
697 *val = lc.lc_data;
698
699 return (error);
700 }
701
702 static int
703 lom2_read_polled(struct lom_softc *sc, uint8_t reg, uint8_t *val)
704 {
705 uint8_t str;
706 int i;
707
708 /* Wait for input buffer to become available. */
709 for (i = 1000; i > 0; i--) {
710 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
711 delay(10);
712 if ((str & LOM2_STATUS_IBF) == 0)
713 break;
714 }
715 if (i == 0)
716 return (ETIMEDOUT);
717
718 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM2_CMD, reg);
719
720 /* Wait until the microcontroller fills output buffer. */
721 for (i = 1000; i > 0; i--) {
722 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
723 delay(10);
724 if (str & LOM2_STATUS_OBF)
725 break;
726 }
727 if (i == 0)
728 return (ETIMEDOUT);
729
730 *val = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_DATA);
731 return (0);
732 }
733
734 static int
735 lom2_write(struct lom_softc *sc, uint8_t reg, uint8_t val)
736 {
737 struct lom_cmd lc;
738 int error;
739
740 if (cold)
741 return lom2_write_polled(sc, reg, val);
742
743 lc.lc_cmd = reg | LOM_IDX_WRITE;
744 lc.lc_data = val;
745 lom2_queue_cmd(sc, &lc);
746
747 error = tsleep(&lc, PZERO, "lom2wr", hz);
748 if (error)
749 lom_dequeue_cmd(sc, &lc);
750
751 return (error);
752 }
753
754 static int
755 lom2_write_polled(struct lom_softc *sc, uint8_t reg, uint8_t val)
756 {
757 uint8_t str;
758 int i;
759
760 /* Wait for input buffer to become available. */
761 for (i = 1000; i > 0; i--) {
762 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
763 delay(10);
764 if ((str & LOM2_STATUS_IBF) == 0)
765 break;
766 }
767 if (i == 0)
768 return (ETIMEDOUT);
769
770 if (sc->sc_space == LOM_IDX_CMD_GENERIC && reg != LOM_IDX_CMD)
771 reg |= LOM_IDX_WRITE;
772
773 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM2_CMD, reg);
774
775 /* Wait until the microcontroller fills output buffer. */
776 for (i = 1000; i > 0; i--) {
777 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
778 delay(10);
779 if (str & LOM2_STATUS_OBF)
780 break;
781 }
782 if (i == 0)
783 return (ETIMEDOUT);
784
785 (void)bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_DATA);
786
787 /* Wait for input buffer to become available. */
788 for (i = 1000; i > 0; i--) {
789 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
790 delay(10);
791 if ((str & LOM2_STATUS_IBF) == 0)
792 break;
793 }
794 if (i == 0)
795 return (ETIMEDOUT);
796
797 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LOM2_DATA, val);
798
799 /* Wait until the microcontroller fills output buffer. */
800 for (i = 1000; i > 0; i--) {
801 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
802 delay(10);
803 if (str & LOM2_STATUS_OBF)
804 break;
805 }
806 if (i == 0)
807 return (ETIMEDOUT);
808
809 (void)bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_DATA);
810
811 /* If we switched spaces, remember the one we're in now. */
812 if (reg == LOM_IDX_CMD)
813 sc->sc_space = val;
814
815 return (0);
816 }
817
818 static void
819 lom2_queue_cmd(struct lom_softc *sc, struct lom_cmd *lc)
820 {
821 uint8_t str;
822
823 mutex_enter(&sc->sc_queue_mtx);
824 TAILQ_INSERT_TAIL(&sc->sc_queue, lc, lc_next);
825 if (sc->sc_state == LOM_STATE_IDLE) {
826 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
827 if ((str & LOM2_STATUS_IBF) == 0) {
828 bus_space_write_1(sc->sc_iot, sc->sc_ioh,
829 LOM2_CMD, lc->lc_cmd);
830 sc->sc_state = LOM_STATE_DATA;
831 }
832 }
833 mutex_exit(&sc->sc_queue_mtx);
834 }
835
836 static int
837 lom2_intr(void *arg)
838 {
839 struct lom_softc *sc = arg;
840 struct lom_cmd *lc;
841 uint8_t str, obr;
842
843 mutex_enter(&sc->sc_queue_mtx);
844
845 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
846 obr = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_DATA);
847
848 lc = TAILQ_FIRST(&sc->sc_queue);
849 if (lc == NULL) {
850 mutex_exit(&sc->sc_queue_mtx);
851 return (0);
852 }
853
854 if (lc->lc_cmd & LOM_IDX_WRITE) {
855 bus_space_write_1(sc->sc_iot, sc->sc_ioh,
856 LOM2_DATA, lc->lc_data);
857 lc->lc_cmd &= ~LOM_IDX_WRITE;
858 mutex_exit(&sc->sc_queue_mtx);
859 return (1);
860 }
861
862 KASSERT(sc->sc_state == LOM_STATE_DATA);
863 lc->lc_data = obr;
864
865 TAILQ_REMOVE(&sc->sc_queue, lc, lc_next);
866
867 wakeup(lc);
868
869 sc->sc_state = LOM_STATE_IDLE;
870
871 if (!TAILQ_EMPTY(&sc->sc_queue)) {
872 str = bus_space_read_1(sc->sc_iot, sc->sc_ioh, LOM2_STATUS);
873 if ((str & LOM2_STATUS_IBF) == 0) {
874 bus_space_write_1(sc->sc_iot, sc->sc_ioh,
875 LOM2_CMD, lc->lc_cmd);
876 sc->sc_state = LOM_STATE_DATA;
877 }
878 }
879
880 mutex_exit(&sc->sc_queue_mtx);
881
882 return (1);
883 }
884
885 static int
886 lom_init_desc(struct lom_softc *sc)
887 {
888 uint8_t val;
889 int i, j, k;
890 int error;
891
892 /* LOMlite doesn't provide sensor descriptions. */
893 if (sc->sc_type < LOM_LOMLITE2)
894 return (0);
895
896 /*
897 * Read temperature sensor names.
898 */
899 error = lom_write(sc, LOM_IDX_CMD, LOM_IDX_CMD_TEMP);
900 if (error)
901 return (error);
902
903 i = 0;
904 j = 0;
905 k = LOM_IDX4_TEMP_NAME_START;
906 while (k <= LOM_IDX4_TEMP_NAME_END) {
907 error = lom_read(sc, k++, &val);
908 if (error)
909 goto fail;
910
911 if (val == 0xff)
912 break;
913
914 if (j < sizeof (sc->sc_temp[i].desc) - 1)
915 sc->sc_temp[i].desc[j++] = val;
916
917 if (val == '\0') {
918 i++;
919 j = 0;
920 if (i < sc->sc_num_temp)
921 continue;
922
923 break;
924 }
925 }
926
927 /*
928 * Read fan names.
929 */
930 error = lom_write(sc, LOM_IDX_CMD, LOM_IDX_CMD_FAN);
931 if (error)
932 return (error);
933
934 i = 0;
935 j = 0;
936 k = LOM_IDX5_FAN_NAME_START;
937 while (k <= LOM_IDX5_FAN_NAME_END) {
938 error = lom_read(sc, k++, &val);
939 if (error)
940 goto fail;
941
942 if (val == 0xff)
943 break;
944
945 if (j < sizeof (sc->sc_fan[i].desc) - 1)
946 sc->sc_fan[i].desc[j++] = val;
947
948 if (val == '\0') {
949 i++;
950 j = 0;
951 if (i < sc->sc_num_fan)
952 continue;
953
954 break;
955 }
956 }
957
958 fail:
959 lom_write(sc, LOM_IDX_CMD, LOM_IDX_CMD_GENERIC);
960 return (error);
961 }
962
963 static void
964 lom_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
965 {
966 struct lom_softc *sc = sme->sme_cookie;
967 uint32_t i;
968
969 /* Sensor number */
970 i = edata->sensor;
971
972 /* Sensor type */
973 switch (edata->units) {
974 case ENVSYS_INDICATOR:
975 if (i < sc->sc_num_alarm)
976 lom_refresh_alarm(sc, edata, i);
977 else
978 lom_refresh_psu(sc, edata,
979 i - sc->sc_num_alarm - sc->sc_num_fan);
980 break;
981 case ENVSYS_SFANRPM:
982 lom_refresh_fan(sc, edata, i - sc->sc_num_alarm);
983 break;
984 case ENVSYS_STEMP:
985 lom_refresh_temp(sc, edata,
986 i - sc->sc_num_alarm - sc->sc_num_fan - sc->sc_num_psu);
987 break;
988 default:
989 edata->state = ENVSYS_SINVALID;
990 break;
991 }
992
993 /*
994 * If our hostname is set and differs from what's stored in
995 * the LOM, write the new hostname back to the LOM. Note that
996 * we include the terminating NUL when writing the hostname
997 * back to the LOM, otherwise the LOM will print any trailing
998 * garbage.
999 */
1000 if (i == 0 && hostnamelen > 0 &&
1001 strncmp(sc->sc_hostname, hostname, sizeof(hostname)) != 0) {
1002 if (sc->sc_type < LOM_LOMLITE2)
1003 lom1_write_hostname(sc);
1004 else
1005 lom2_write_hostname(sc);
1006 strlcpy(sc->sc_hostname, hostname, sizeof(hostname));
1007 }
1008 }
1009
1010 static void
1011 lom_refresh_alarm(struct lom_softc *sc, envsys_data_t *edata, uint32_t i)
1012 {
1013 uint8_t val;
1014
1015 /* Fault LED or Alarms */
1016 KASSERT(i < sc->sc_num_alarm);
1017
1018 /* Read new value at most once every second. */
1019 if (ratecheck(&sc->sc_alarm_lastread, &refresh_interval)) {
1020 if (lom_read(sc, LOM_IDX_ALARM, &val)) {
1021 edata->state = ENVSYS_SINVALID;
1022 return;
1023 }
1024 sc->sc_alarm_lastval = val;
1025 } else {
1026 val = sc->sc_alarm_lastval;
1027 }
1028
1029 if (i == 0) {
1030 /* Fault LED */
1031 if ((val & LOM_ALARM_FAULT) == LOM_ALARM_FAULT)
1032 edata->value_cur = 0;
1033 else
1034 edata->value_cur = 1;
1035 } else {
1036 /* Alarms */
1037 if ((val & (LOM_ALARM_1 << (i - 1))) == 0)
1038 edata->value_cur = 0;
1039 else
1040 edata->value_cur = 1;
1041 }
1042 edata->state = ENVSYS_SVALID;
1043 }
1044
1045 static void
1046 lom_refresh_fan(struct lom_softc *sc, envsys_data_t *edata, uint32_t i)
1047 {
1048 uint8_t val;
1049
1050 /* Fan speed */
1051 KASSERT(i < sc->sc_num_fan);
1052
1053 /* Read new value at most once every second. */
1054 if (!ratecheck(&sc->sc_fan_lastread[i], &refresh_interval))
1055 return;
1056
1057 if (lom_read(sc, LOM_IDX_FAN1 + i, &val)) {
1058 edata->state = ENVSYS_SINVALID;
1059 } else {
1060 edata->value_cur = (60 * sc->sc_fan_cal[i] * val) / 100;
1061 if (val < sc->sc_fan_low[i])
1062 edata->state = ENVSYS_SCRITICAL;
1063 else
1064 edata->state = ENVSYS_SVALID;
1065 }
1066 }
1067
1068 static void
1069 lom_refresh_psu(struct lom_softc *sc, envsys_data_t *edata, uint32_t i)
1070 {
1071 uint8_t val;
1072
1073 /* PSU status */
1074 KASSERT(i < sc->sc_num_psu);
1075
1076 /* Read new value at most once every second. */
1077 if (!ratecheck(&sc->sc_psu_lastread[i], &refresh_interval))
1078 return;
1079
1080 if (lom_read(sc, LOM_IDX_PSU1 + i, &val) ||
1081 !ISSET(val, LOM_PSU_PRESENT)) {
1082 edata->state = ENVSYS_SINVALID;
1083 } else {
1084 if (val & LOM_PSU_STANDBY) {
1085 edata->value_cur = 0;
1086 edata->state = ENVSYS_SVALID;
1087 } else {
1088 edata->value_cur = 1;
1089 if (ISSET(val, LOM_PSU_INPUTA) &&
1090 ISSET(val, LOM_PSU_INPUTB) &&
1091 ISSET(val, LOM_PSU_OUTPUT))
1092 edata->state = ENVSYS_SVALID;
1093 else
1094 edata->state = ENVSYS_SCRITICAL;
1095 }
1096 }
1097 }
1098
1099 static void
1100 lom_refresh_temp(struct lom_softc *sc, envsys_data_t *edata, uint32_t i)
1101 {
1102 uint8_t val;
1103
1104 /* Temperature */
1105 KASSERT(i < sc->sc_num_temp);
1106
1107 /* Read new value at most once every second. */
1108 if (!ratecheck(&sc->sc_temp_lastread[i], &refresh_interval))
1109 return;
1110
1111 if (lom_read(sc, LOM_IDX_TEMP1 + i, &val)) {
1112 edata->state = ENVSYS_SINVALID;
1113 } else {
1114 edata->value_cur = val * 1000000 + 273150000;
1115 edata->state = ENVSYS_SVALID;
1116 }
1117 }
1118
1119 static void
1120 lom1_write_hostname(struct lom_softc *sc)
1121 {
1122 char name[(LOM1_IDX_HOSTNAME12 - LOM1_IDX_HOSTNAME1 + 1) + 1];
1123 char *p;
1124 int i;
1125
1126 /*
1127 * LOMlite generally doesn't have enough space to store the
1128 * fully qualified hostname. If the hostname is too long,
1129 * strip off the domain name.
1130 */
1131 strlcpy(name, hostname, sizeof(name));
1132 if (hostnamelen >= sizeof(name)) {
1133 p = strchr(name, '.');
1134 if (p)
1135 *p = '\0';
1136 }
1137
1138 for (i = 0; i < strlen(name) + 1; i++)
1139 if (lom_write(sc, LOM1_IDX_HOSTNAME1 + i, name[i]))
1140 break;
1141 }
1142
1143 static void
1144 lom2_write_hostname(struct lom_softc *sc)
1145 {
1146 int i;
1147
1148 lom_write(sc, LOM2_IDX_HOSTNAMELEN, hostnamelen + 1);
1149 for (i = 0; i < hostnamelen + 1; i++)
1150 lom_write(sc, LOM2_IDX_HOSTNAME, hostname[i]);
1151 }
1152
1153 static int
1154 lom_wdog_tickle(struct sysmon_wdog *smw)
1155 {
1156 struct lom_softc *sc = smw->smw_cookie;
1157
1158 /* Pat the dog. */
1159 sc->sc_wdog_pat.lc_cmd = LOM_IDX_WDOG_CTL | LOM_IDX_WRITE;
1160 sc->sc_wdog_pat.lc_data = sc->sc_wdog_ctl;
1161 lom_queue_cmd(sc, &sc->sc_wdog_pat);
1162
1163 return 0;
1164 }
1165
1166 static int
1167 lom_wdog_setmode(struct sysmon_wdog *smw)
1168 {
1169 struct lom_softc *sc = smw->smw_cookie;
1170
1171 if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
1172 /* disable watchdog */
1173 sc->sc_wdog_ctl &= ~(LOM_WDOG_ENABLE|LOM_WDOG_RESET);
1174 lom_write(sc, LOM_IDX_WDOG_CTL, sc->sc_wdog_ctl);
1175 } else {
1176 if (smw->smw_period == WDOG_PERIOD_DEFAULT)
1177 smw->smw_period = sc->sc_wdog_period;
1178 else if (smw->smw_period == 0 ||
1179 smw->smw_period > LOM_WDOG_TIME_MAX)
1180 return EINVAL;
1181 lom_write(sc, LOM_IDX_WDOG_TIME, smw->smw_period);
1182
1183 /* enable watchdog */
1184 lom_dequeue_cmd(sc, &sc->sc_wdog_pat);
1185 sc->sc_wdog_ctl |= LOM_WDOG_ENABLE|LOM_WDOG_RESET;
1186 sc->sc_wdog_pat.lc_cmd = LOM_IDX_WDOG_CTL | LOM_IDX_WRITE;
1187 sc->sc_wdog_pat.lc_data = sc->sc_wdog_ctl;
1188 lom_queue_cmd(sc, &sc->sc_wdog_pat);
1189 }
1190
1191 return 0;
1192 }
1193
1194 static bool
1195 lom_shutdown(device_t dev, int how)
1196 {
1197 struct lom_softc *sc = device_private(dev);
1198
1199 sc->sc_wdog_ctl &= ~LOM_WDOG_ENABLE;
1200 lom_write(sc, LOM_IDX_WDOG_CTL, sc->sc_wdog_ctl);
1201 return true;
1202 }
1203
1204 static int
1205 lom_sysctl_alarm(SYSCTLFN_ARGS)
1206 {
1207 struct sysctlnode node;
1208 struct lom_softc *sc;
1209 int i, tmp, error;
1210 uint8_t val;
1211
1212 node = *rnode;
1213 sc = node.sysctl_data;
1214
1215 for (i = 0; i < sc->sc_num_alarm; i++) {
1216 if (node.sysctl_num == sc->sc_sysctl_num[i]) {
1217 lom_refresh_alarm(sc, &sc->sc_alarm[i], i);
1218 tmp = sc->sc_alarm[i].value_cur;
1219 node.sysctl_data = &tmp;
1220 error = sysctl_lookup(SYSCTLFN_CALL(&node));
1221 if (error || newp == NULL)
1222 return error;
1223 if (tmp < 0 || tmp > 1)
1224 return EINVAL;
1225
1226 if (lom_read(sc, LOM_IDX_ALARM, &val))
1227 return EINVAL;
1228 if (i == 0) {
1229 /* Fault LED */
1230 if (tmp != 0)
1231 val &= ~LOM_ALARM_FAULT;
1232 else
1233 val |= LOM_ALARM_FAULT;
1234 } else {
1235 /* Alarms */
1236 if (tmp != 0)
1237 val |= LOM_ALARM_1 << (i - 1);
1238 else
1239 val &= ~(LOM_ALARM_1 << (i - 1));
1240 }
1241 if (lom_write(sc, LOM_IDX_ALARM, val))
1242 return EINVAL;
1243
1244 sc->sc_alarm[i].value_cur = tmp;
1245 return 0;
1246 }
1247 }
1248
1249 return ENOENT;
1250 }
1251