ichlpcib.c revision 1.24 1 /* $NetBSD: ichlpcib.c,v 1.24 2010/02/24 22:37:55 dyoung Exp $ */
2
3 /*-
4 * Copyright (c) 2004 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Minoura Makoto and Matthew R. Green.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 /*
33 * Intel I/O Controller Hub (ICHn) LPC Interface Bridge driver
34 *
35 * LPC Interface Bridge is basically a pcib (PCI-ISA Bridge), but has
36 * some power management and monitoring functions.
37 * Currently we support the watchdog timer, SpeedStep (on some systems)
38 * and the power management timer.
39 */
40
41 #include <sys/cdefs.h>
42 __KERNEL_RCSID(0, "$NetBSD: ichlpcib.c,v 1.24 2010/02/24 22:37:55 dyoung Exp $");
43
44 #include <sys/types.h>
45 #include <sys/param.h>
46 #include <sys/systm.h>
47 #include <sys/device.h>
48 #include <sys/sysctl.h>
49 #include <sys/timetc.h>
50 #include <sys/gpio.h>
51 #include <machine/bus.h>
52
53 #include <dev/pci/pcivar.h>
54 #include <dev/pci/pcireg.h>
55 #include <dev/pci/pcidevs.h>
56
57 #include <dev/gpio/gpiovar.h>
58 #include <dev/sysmon/sysmonvar.h>
59
60 #include <dev/ic/acpipmtimer.h>
61 #include <dev/ic/i82801lpcreg.h>
62 #include <dev/ic/hpetreg.h>
63 #include <dev/ic/hpetvar.h>
64
65 #include "hpet.h"
66 #include "pcibvar.h"
67 #include "gpio.h"
68
69 #define LPCIB_GPIO_NPINS 64
70
71 struct lpcib_softc {
72 /* we call pcibattach() which assumes this starts like this: */
73 struct pcib_softc sc_pcib;
74
75 struct pci_attach_args sc_pa;
76 int sc_has_rcba;
77 int sc_has_ich5_hpet;
78
79 /* RCBA */
80 bus_space_tag_t sc_rcbat;
81 bus_space_handle_t sc_rcbah;
82 pcireg_t sc_rcba_reg;
83
84 /* Watchdog variables. */
85 struct sysmon_wdog sc_smw;
86 bus_space_tag_t sc_iot;
87 bus_space_handle_t sc_ioh;
88 bus_size_t sc_iosize;
89
90 #if NHPET > 0
91 /* HPET variables. */
92 uint32_t sc_hpet_reg;
93 #endif
94
95 #if NGPIO > 0
96 device_t sc_gpiobus;
97 kmutex_t sc_gpio_mtx;
98 bus_space_tag_t sc_gpio_iot;
99 bus_space_handle_t sc_gpio_ioh;
100 bus_size_t sc_gpio_ios;
101 struct gpio_chipset_tag sc_gpio_gc;
102 gpio_pin_t sc_gpio_pins[LPCIB_GPIO_NPINS];
103 #endif
104
105 /* Speedstep */
106 pcireg_t sc_pmcon_orig;
107
108 /* Power management */
109 pcireg_t sc_pirq[2];
110 pcireg_t sc_pmcon;
111 pcireg_t sc_fwhsel2;
112
113 /* Child devices */
114 device_t sc_hpetbus;
115 acpipmtimer_t sc_pmtimer;
116 pcireg_t sc_acpi_cntl;
117
118 struct sysctllog *sc_log;
119 };
120
121 static int lpcibmatch(device_t, cfdata_t, void *);
122 static void lpcibattach(device_t, device_t, void *);
123 static int lpcibdetach(device_t, int);
124 static void lpcibchilddet(device_t, device_t);
125 static int lpcibrescan(device_t, const char *, const int *);
126 static bool lpcib_suspend(device_t, const pmf_qual_t *);
127 static bool lpcib_resume(device_t, const pmf_qual_t *);
128 static bool lpcib_shutdown(device_t, int);
129
130 static void pmtimer_configure(device_t);
131 static int pmtimer_unconfigure(device_t, int);
132
133 static void tcotimer_configure(device_t);
134 static int tcotimer_unconfigure(device_t, int);
135 static int tcotimer_setmode(struct sysmon_wdog *);
136 static int tcotimer_tickle(struct sysmon_wdog *);
137 static void tcotimer_stop(struct lpcib_softc *);
138 static void tcotimer_start(struct lpcib_softc *);
139 static void tcotimer_status_reset(struct lpcib_softc *);
140 static int tcotimer_disable_noreboot(device_t);
141
142 static void speedstep_configure(device_t);
143 static void speedstep_unconfigure(device_t);
144 static int speedstep_sysctl_helper(SYSCTLFN_ARGS);
145
146 #if NHPET > 0
147 static void lpcib_hpet_configure(device_t);
148 static int lpcib_hpet_unconfigure(device_t, int);
149 #endif
150
151 #if NGPIO > 0
152 static void lpcib_gpio_configure(device_t);
153 static int lpcib_gpio_unconfigure(device_t, int);
154 static int lpcib_gpio_pin_read(void *, int);
155 static void lpcib_gpio_pin_write(void *, int, int);
156 static void lpcib_gpio_pin_ctl(void *, int, int);
157 #endif
158
159 struct lpcib_softc *speedstep_cookie; /* XXX */
160
161 CFATTACH_DECL2_NEW(ichlpcib, sizeof(struct lpcib_softc),
162 lpcibmatch, lpcibattach, lpcibdetach, NULL, lpcibrescan, lpcibchilddet);
163
164 static struct lpcib_device {
165 pcireg_t vendor, product;
166 int has_rcba;
167 int has_ich5_hpet;
168 } lpcib_devices[] = {
169 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801AA_LPC, 0, 0 },
170 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801BA_LPC, 0, 0 },
171 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801BAM_LPC, 0, 0 },
172 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801CA_LPC, 0, 0 },
173 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801CAM_LPC, 0, 0 },
174 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801DB_LPC, 0, 0 },
175 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801DB_ISA, 0, 0 },
176 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801EB_LPC, 0, 1 },
177 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801FB_LPC, 1, 0 },
178 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801FBM_LPC, 1, 0 },
179 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801G_LPC, 1, 0 },
180 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801GBM_LPC, 1, 0 },
181 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801GHM_LPC, 1, 0 },
182 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801H_LPC, 1, 0 },
183 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801HEM_LPC, 1, 0 },
184 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801HH_LPC, 1, 0 },
185 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801HO_LPC, 1, 0 },
186 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801HBM_LPC, 1, 0 },
187 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801IH_LPC, 1, 0 },
188 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801IO_LPC, 1, 0 },
189 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801IR_LPC, 1, 0 },
190 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801IEM_LPC, 1, 0 },
191 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801IB_LPC, 1, 0 },
192 { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_63XXESB_LPC, 1, 0 },
193
194 { 0, 0, 0, 0 },
195 };
196
197 /*
198 * Autoconf callbacks.
199 */
200 static int
201 lpcibmatch(device_t parent, cfdata_t match, void *aux)
202 {
203 struct pci_attach_args *pa = aux;
204 struct lpcib_device *lpcib_dev;
205
206 /* We are ISA bridge, of course */
207 if (PCI_CLASS(pa->pa_class) != PCI_CLASS_BRIDGE ||
208 PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_BRIDGE_ISA)
209 return 0;
210
211 for (lpcib_dev = lpcib_devices; lpcib_dev->vendor; ++lpcib_dev) {
212 if (PCI_VENDOR(pa->pa_id) == lpcib_dev->vendor &&
213 PCI_PRODUCT(pa->pa_id) == lpcib_dev->product)
214 return 10;
215 }
216
217 return 0;
218 }
219
220 static void
221 lpcibattach(device_t parent, device_t self, void *aux)
222 {
223 struct pci_attach_args *pa = aux;
224 struct lpcib_softc *sc = device_private(self);
225 struct lpcib_device *lpcib_dev;
226
227 sc->sc_pa = *pa;
228
229 for (lpcib_dev = lpcib_devices; lpcib_dev->vendor; ++lpcib_dev) {
230 if (PCI_VENDOR(pa->pa_id) != lpcib_dev->vendor ||
231 PCI_PRODUCT(pa->pa_id) != lpcib_dev->product)
232 continue;
233 sc->sc_has_rcba = lpcib_dev->has_rcba;
234 sc->sc_has_ich5_hpet = lpcib_dev->has_ich5_hpet;
235 break;
236 }
237
238 pcibattach(parent, self, aux);
239
240 /*
241 * Part of our I/O registers are used as ACPI PM regs.
242 * Since our ACPI subsystem accesses the I/O space directly so far,
243 * we do not have to bother bus_space I/O map confliction.
244 */
245 if (pci_mapreg_map(pa, LPCIB_PCI_PMBASE, PCI_MAPREG_TYPE_IO, 0,
246 &sc->sc_iot, &sc->sc_ioh, NULL, &sc->sc_iosize)) {
247 aprint_error_dev(self, "can't map power management i/o space");
248 return;
249 }
250
251 sc->sc_pmcon_orig = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
252 LPCIB_PCI_GEN_PMCON_1);
253
254 /* For ICH6 and later, always enable RCBA */
255 if (sc->sc_has_rcba) {
256 pcireg_t rcba;
257
258 sc->sc_rcbat = sc->sc_pa.pa_memt;
259
260 rcba = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
261 LPCIB_RCBA);
262 if ((rcba & LPCIB_RCBA_EN) == 0) {
263 aprint_error_dev(self, "RCBA is not enabled");
264 return;
265 }
266 rcba &= ~LPCIB_RCBA_EN;
267
268 if (bus_space_map(sc->sc_rcbat, rcba, LPCIB_RCBA_SIZE, 0,
269 &sc->sc_rcbah)) {
270 aprint_error_dev(self, "RCBA could not be mapped");
271 return;
272 }
273 }
274
275 /* Set up the power management timer. */
276 pmtimer_configure(self);
277
278 /* Set up the TCO (watchdog). */
279 tcotimer_configure(self);
280
281 /* Set up SpeedStep. */
282 speedstep_configure(self);
283
284 #if NHPET > 0
285 /* Set up HPET. */
286 lpcib_hpet_configure(self);
287 #endif
288
289 #if NGPIO > 0
290 /* Set up GPIO */
291 lpcib_gpio_configure(self);
292 #endif
293
294 /* Install power handler */
295 if (!pmf_device_register1(self, lpcib_suspend, lpcib_resume,
296 lpcib_shutdown))
297 aprint_error_dev(self, "couldn't establish power handler\n");
298 }
299
300 static void
301 lpcibchilddet(device_t self, device_t child)
302 {
303 struct lpcib_softc *sc = device_private(self);
304 uint32_t val;
305
306 #if NGPIO > 0
307 if (sc->sc_gpiobus == child) {
308 sc->sc_gpiobus = NULL;
309 return;
310 }
311 #endif
312 if (sc->sc_hpetbus != child) {
313 pcibchilddet(self, child);
314 return;
315 }
316 sc->sc_hpetbus = NULL;
317 if (sc->sc_has_ich5_hpet) {
318 val = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
319 LPCIB_PCI_GEN_CNTL);
320 switch (val & LPCIB_ICH5_HPTC_WIN_MASK) {
321 case LPCIB_ICH5_HPTC_0000:
322 case LPCIB_ICH5_HPTC_1000:
323 case LPCIB_ICH5_HPTC_2000:
324 case LPCIB_ICH5_HPTC_3000:
325 break;
326 default:
327 return;
328 }
329 val &= ~LPCIB_ICH5_HPTC_EN;
330 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
331 LPCIB_PCI_GEN_CNTL, val);
332 } else if (sc->sc_has_rcba) {
333 val = bus_space_read_4(sc->sc_rcbat, sc->sc_rcbah,
334 LPCIB_RCBA_HPTC);
335 switch (val & LPCIB_RCBA_HPTC_WIN_MASK) {
336 case LPCIB_RCBA_HPTC_0000:
337 case LPCIB_RCBA_HPTC_1000:
338 case LPCIB_RCBA_HPTC_2000:
339 case LPCIB_RCBA_HPTC_3000:
340 break;
341 default:
342 return;
343 }
344 val &= ~LPCIB_RCBA_HPTC_EN;
345 bus_space_write_4(sc->sc_rcbat, sc->sc_rcbah, LPCIB_RCBA_HPTC,
346 val);
347 }
348 }
349
350 static int
351 lpcibrescan(device_t self, const char *ifattr, const int *locators)
352 {
353 #if NHPET > 0 || NGPIO > 0
354 struct lpcib_softc *sc = device_private(self);
355 #endif
356
357 #if NHPET > 0
358 if (ifattr_match(ifattr, "hpetichbus") && sc->sc_hpetbus == NULL)
359 lpcib_hpet_configure(self);
360 #endif
361
362 #if NGPIO > 0
363 if (ifattr_match(ifattr, "gpiobus") && sc->sc_gpiobus == NULL)
364 lpcib_gpio_configure(self);
365 #endif
366
367 return pcibrescan(self, ifattr, locators);
368 }
369
370 static int
371 lpcibdetach(device_t self, int flags)
372 {
373 struct lpcib_softc *sc = device_private(self);
374 int rc;
375
376 pmf_device_deregister(self);
377
378 #if NHPET > 0
379 if ((rc = lpcib_hpet_unconfigure(self, flags)) != 0)
380 return rc;
381 #endif
382
383 #if NGPIO > 0
384 if ((rc = lpcib_gpio_unconfigure(self, flags)) != 0)
385 return rc;
386 #endif
387
388 /* Set up SpeedStep. */
389 speedstep_unconfigure(self);
390
391 if ((rc = tcotimer_unconfigure(self, flags)) != 0)
392 return rc;
393
394 if ((rc = pmtimer_unconfigure(self, flags)) != 0)
395 return rc;
396
397 if (sc->sc_has_rcba)
398 bus_space_unmap(sc->sc_rcbat, sc->sc_rcbah, LPCIB_RCBA_SIZE);
399
400 bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_iosize);
401
402 return pcibdetach(self, flags);
403 }
404
405 static bool
406 lpcib_shutdown(device_t dv, int howto)
407 {
408 struct lpcib_softc *sc = device_private(dv);
409
410 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
411 LPCIB_PCI_GEN_PMCON_1, sc->sc_pmcon_orig);
412
413 return true;
414 }
415
416 static bool
417 lpcib_suspend(device_t dv, const pmf_qual_t *qual)
418 {
419 struct lpcib_softc *sc = device_private(dv);
420 pci_chipset_tag_t pc = sc->sc_pcib.sc_pc;
421 pcitag_t tag = sc->sc_pcib.sc_tag;
422
423 /* capture PIRQ routing control registers */
424 sc->sc_pirq[0] = pci_conf_read(pc, tag, LPCIB_PCI_PIRQA_ROUT);
425 sc->sc_pirq[1] = pci_conf_read(pc, tag, LPCIB_PCI_PIRQE_ROUT);
426
427 sc->sc_pmcon = pci_conf_read(pc, tag, LPCIB_PCI_GEN_PMCON_1);
428 sc->sc_fwhsel2 = pci_conf_read(pc, tag, LPCIB_PCI_GEN_STA);
429
430 if (sc->sc_has_rcba) {
431 sc->sc_rcba_reg = pci_conf_read(pc, tag, LPCIB_RCBA);
432 #if NHPET > 0
433 sc->sc_hpet_reg = bus_space_read_4(sc->sc_rcbat, sc->sc_rcbah,
434 LPCIB_RCBA_HPTC);
435 #endif
436 } else if (sc->sc_has_ich5_hpet) {
437 #if NHPET > 0
438 sc->sc_hpet_reg = pci_conf_read(pc, tag, LPCIB_PCI_GEN_CNTL);
439 #endif
440 }
441
442 return true;
443 }
444
445 static bool
446 lpcib_resume(device_t dv, const pmf_qual_t *qual)
447 {
448 struct lpcib_softc *sc = device_private(dv);
449 pci_chipset_tag_t pc = sc->sc_pcib.sc_pc;
450 pcitag_t tag = sc->sc_pcib.sc_tag;
451
452 /* restore PIRQ routing control registers */
453 pci_conf_write(pc, tag, LPCIB_PCI_PIRQA_ROUT, sc->sc_pirq[0]);
454 pci_conf_write(pc, tag, LPCIB_PCI_PIRQE_ROUT, sc->sc_pirq[1]);
455
456 pci_conf_write(pc, tag, LPCIB_PCI_GEN_PMCON_1, sc->sc_pmcon);
457 pci_conf_write(pc, tag, LPCIB_PCI_GEN_STA, sc->sc_fwhsel2);
458
459 if (sc->sc_has_rcba) {
460 pci_conf_write(pc, tag, LPCIB_RCBA, sc->sc_rcba_reg);
461 #if NHPET > 0
462 bus_space_write_4(sc->sc_rcbat, sc->sc_rcbah, LPCIB_RCBA_HPTC,
463 sc->sc_hpet_reg);
464 #endif
465 } else if (sc->sc_has_ich5_hpet) {
466 #if NHPET > 0
467 pci_conf_write(pc, tag, LPCIB_PCI_GEN_CNTL, sc->sc_hpet_reg);
468 #endif
469 }
470
471 return true;
472 }
473
474 /*
475 * Initialize the power management timer.
476 */
477 static void
478 pmtimer_configure(device_t self)
479 {
480 struct lpcib_softc *sc = device_private(self);
481 pcireg_t control;
482
483 /*
484 * Check if power management I/O space is enabled and enable the ACPI_EN
485 * bit if it's disabled.
486 */
487 control = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
488 LPCIB_PCI_ACPI_CNTL);
489 sc->sc_acpi_cntl = control;
490 if ((control & LPCIB_PCI_ACPI_CNTL_EN) == 0) {
491 control |= LPCIB_PCI_ACPI_CNTL_EN;
492 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
493 LPCIB_PCI_ACPI_CNTL, control);
494 }
495
496 /* Attach our PM timer with the generic acpipmtimer function */
497 sc->sc_pmtimer = acpipmtimer_attach(self, sc->sc_iot, sc->sc_ioh,
498 LPCIB_PM1_TMR, 0);
499 }
500
501 static int
502 pmtimer_unconfigure(device_t self, int flags)
503 {
504 struct lpcib_softc *sc = device_private(self);
505 int rc;
506
507 if (sc->sc_pmtimer != NULL &&
508 (rc = acpipmtimer_detach(sc->sc_pmtimer, flags)) != 0)
509 return rc;
510
511 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
512 LPCIB_PCI_ACPI_CNTL, sc->sc_acpi_cntl);
513
514 return 0;
515 }
516
517 /*
518 * Initialize the watchdog timer.
519 */
520 static void
521 tcotimer_configure(device_t self)
522 {
523 struct lpcib_softc *sc = device_private(self);
524 uint32_t ioreg;
525 unsigned int period;
526
527 /* Explicitly stop the TCO timer. */
528 tcotimer_stop(sc);
529
530 /*
531 * Enable TCO timeout SMI only if the hardware reset does not
532 * work. We don't know what the SMBIOS does.
533 */
534 ioreg = bus_space_read_4(sc->sc_iot, sc->sc_ioh, LPCIB_SMI_EN);
535 ioreg &= ~LPCIB_SMI_EN_TCO_EN;
536
537 /*
538 * Clear the No Reboot (NR) bit. If this fails, enabling the TCO_EN bit
539 * in the SMI_EN register is the last chance.
540 */
541 if (tcotimer_disable_noreboot(self)) {
542 ioreg |= LPCIB_SMI_EN_TCO_EN;
543 }
544 if ((ioreg & LPCIB_SMI_EN_GBL_SMI_EN) != 0) {
545 bus_space_write_4(sc->sc_iot, sc->sc_ioh, LPCIB_SMI_EN, ioreg);
546 }
547
548 /* Reset the watchdog status registers. */
549 tcotimer_status_reset(sc);
550
551 /*
552 * Register the driver with the sysmon watchdog framework.
553 */
554 sc->sc_smw.smw_name = device_xname(self);
555 sc->sc_smw.smw_cookie = sc;
556 sc->sc_smw.smw_setmode = tcotimer_setmode;
557 sc->sc_smw.smw_tickle = tcotimer_tickle;
558 if (sc->sc_has_rcba)
559 period = LPCIB_TCOTIMER2_MAX_TICK;
560 else
561 period = LPCIB_TCOTIMER_MAX_TICK;
562 sc->sc_smw.smw_period = lpcib_tcotimer_tick_to_second(period);
563
564 if (sysmon_wdog_register(&sc->sc_smw)) {
565 aprint_error_dev(self, "unable to register TCO timer"
566 "as a sysmon watchdog device.\n");
567 return;
568 }
569
570 aprint_verbose_dev(self, "TCO (watchdog) timer configured.\n");
571 }
572
573 static int
574 tcotimer_unconfigure(device_t self, int flags)
575 {
576 struct lpcib_softc *sc = device_private(self);
577 int rc;
578
579 if ((rc = sysmon_wdog_unregister(&sc->sc_smw)) != 0) {
580 if (rc == ERESTART)
581 rc = EINTR;
582 return rc;
583 }
584
585 /* Explicitly stop the TCO timer. */
586 tcotimer_stop(sc);
587
588 /* XXX Set No Reboot? */
589
590 return 0;
591 }
592
593
594 /*
595 * Sysmon watchdog callbacks.
596 */
597 static int
598 tcotimer_setmode(struct sysmon_wdog *smw)
599 {
600 struct lpcib_softc *sc = smw->smw_cookie;
601 unsigned int period;
602 uint16_t ich6period = 0;
603 uint8_t ich5period = 0;
604
605 if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
606 /* Stop the TCO timer. */
607 tcotimer_stop(sc);
608 } else {
609 /*
610 * ICH6 or newer are limited to 2s min and 613s max.
611 * ICH5 or older are limited to 4s min and 39s max.
612 */
613 period = lpcib_tcotimer_second_to_tick(smw->smw_period);
614 if (sc->sc_has_rcba) {
615 if (period < LPCIB_TCOTIMER2_MIN_TICK ||
616 period > LPCIB_TCOTIMER2_MAX_TICK)
617 return EINVAL;
618 } else {
619 if (period < LPCIB_TCOTIMER_MIN_TICK ||
620 period > LPCIB_TCOTIMER_MAX_TICK)
621 return EINVAL;
622 }
623
624 /* Stop the TCO timer, */
625 tcotimer_stop(sc);
626
627 /* set the timeout, */
628 if (sc->sc_has_rcba) {
629 /* ICH6 or newer */
630 ich6period = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
631 LPCIB_TCO_TMR2);
632 ich6period &= 0xfc00;
633 bus_space_write_2(sc->sc_iot, sc->sc_ioh,
634 LPCIB_TCO_TMR2, ich6period | period);
635 } else {
636 /* ICH5 or older */
637 ich5period = bus_space_read_1(sc->sc_iot, sc->sc_ioh,
638 LPCIB_TCO_TMR);
639 ich5period &= 0xc0;
640 bus_space_write_1(sc->sc_iot, sc->sc_ioh,
641 LPCIB_TCO_TMR, ich5period | period);
642 }
643
644 /* and start/reload the timer. */
645 tcotimer_start(sc);
646 tcotimer_tickle(smw);
647 }
648
649 return 0;
650 }
651
652 static int
653 tcotimer_tickle(struct sysmon_wdog *smw)
654 {
655 struct lpcib_softc *sc = smw->smw_cookie;
656
657 /* any value is allowed */
658 if (sc->sc_has_rcba)
659 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO_RLD, 1);
660 else
661 bus_space_write_1(sc->sc_iot, sc->sc_ioh, LPCIB_TCO_RLD, 1);
662
663 return 0;
664 }
665
666 static void
667 tcotimer_stop(struct lpcib_softc *sc)
668 {
669 uint16_t ioreg;
670
671 ioreg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO1_CNT);
672 ioreg |= LPCIB_TCO1_CNT_TCO_TMR_HLT;
673 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO1_CNT, ioreg);
674 }
675
676 static void
677 tcotimer_start(struct lpcib_softc *sc)
678 {
679 uint16_t ioreg;
680
681 ioreg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO1_CNT);
682 ioreg &= ~LPCIB_TCO1_CNT_TCO_TMR_HLT;
683 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO1_CNT, ioreg);
684 }
685
686 static void
687 tcotimer_status_reset(struct lpcib_softc *sc)
688 {
689 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO1_STS,
690 LPCIB_TCO1_STS_TIMEOUT);
691 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO2_STS,
692 LPCIB_TCO2_STS_BOOT_STS);
693 bus_space_write_2(sc->sc_iot, sc->sc_ioh, LPCIB_TCO2_STS,
694 LPCIB_TCO2_STS_SECONDS_TO_STS);
695 }
696
697 /*
698 * Clear the No Reboot (NR) bit, this enables reboots when the timer
699 * reaches the timeout for the second time.
700 */
701 static int
702 tcotimer_disable_noreboot(device_t self)
703 {
704 struct lpcib_softc *sc = device_private(self);
705
706 if (sc->sc_has_rcba) {
707 uint32_t status;
708
709 status = bus_space_read_4(sc->sc_rcbat, sc->sc_rcbah,
710 LPCIB_GCS_OFFSET);
711 status &= ~LPCIB_GCS_NO_REBOOT;
712 bus_space_write_4(sc->sc_rcbat, sc->sc_rcbah,
713 LPCIB_GCS_OFFSET, status);
714 status = bus_space_read_4(sc->sc_rcbat, sc->sc_rcbah,
715 LPCIB_GCS_OFFSET);
716 if (status & LPCIB_GCS_NO_REBOOT)
717 goto error;
718 } else {
719 pcireg_t pcireg;
720
721 pcireg = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
722 LPCIB_PCI_GEN_STA);
723 if (pcireg & LPCIB_PCI_GEN_STA_NO_REBOOT) {
724 /* TCO timeout reset is disabled; try to enable it */
725 pcireg &= ~LPCIB_PCI_GEN_STA_NO_REBOOT;
726 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
727 LPCIB_PCI_GEN_STA, pcireg);
728 if (pcireg & LPCIB_PCI_GEN_STA_NO_REBOOT)
729 goto error;
730 }
731 }
732
733 return 0;
734 error:
735 aprint_error_dev(self, "TCO timer reboot disabled by hardware; "
736 "hope SMBIOS properly handles it.\n");
737 return EINVAL;
738 }
739
740
741 /*
742 * Intel ICH SpeedStep support.
743 */
744 #define SS_READ(sc, reg) \
745 bus_space_read_1((sc)->sc_iot, (sc)->sc_ioh, (reg))
746 #define SS_WRITE(sc, reg, val) \
747 bus_space_write_1((sc)->sc_iot, (sc)->sc_ioh, (reg), (val))
748
749 /*
750 * Linux driver says that SpeedStep on older chipsets cause
751 * lockups on Dell Inspiron 8000 and 8100.
752 * It should also not be enabled on systems with the 82855GM
753 * Hub, which typically have an EST-enabled CPU.
754 */
755 static int
756 speedstep_bad_hb_check(struct pci_attach_args *pa)
757 {
758
759 if (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_INTEL_82815_FULL_HUB &&
760 PCI_REVISION(pa->pa_class) < 5)
761 return 1;
762
763 if (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_INTEL_82855GM_MCH)
764 return 1;
765
766 return 0;
767 }
768
769 static void
770 speedstep_configure(device_t self)
771 {
772 struct lpcib_softc *sc = device_private(self);
773 const struct sysctlnode *node, *ssnode;
774 int rv;
775
776 /* Supported on ICH2-M, ICH3-M and ICH4-M. */
777 if (PCI_PRODUCT(sc->sc_pa.pa_id) == PCI_PRODUCT_INTEL_82801DB_ISA ||
778 PCI_PRODUCT(sc->sc_pa.pa_id) == PCI_PRODUCT_INTEL_82801CAM_LPC ||
779 (PCI_PRODUCT(sc->sc_pa.pa_id) == PCI_PRODUCT_INTEL_82801BAM_LPC &&
780 pci_find_device(&sc->sc_pa, speedstep_bad_hb_check) == 0)) {
781 pcireg_t pmcon;
782
783 /* Enable SpeedStep if it isn't already enabled. */
784 pmcon = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
785 LPCIB_PCI_GEN_PMCON_1);
786 if ((pmcon & LPCIB_PCI_GEN_PMCON_1_SS_EN) == 0)
787 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
788 LPCIB_PCI_GEN_PMCON_1,
789 pmcon | LPCIB_PCI_GEN_PMCON_1_SS_EN);
790
791 /* Put in machdep.speedstep_state (0 for low, 1 for high). */
792 if ((rv = sysctl_createv(&sc->sc_log, 0, NULL, &node,
793 CTLFLAG_PERMANENT, CTLTYPE_NODE, "machdep", NULL,
794 NULL, 0, NULL, 0, CTL_MACHDEP, CTL_EOL)) != 0)
795 goto err;
796
797 /* CTLFLAG_ANYWRITE? kernel option like EST? */
798 if ((rv = sysctl_createv(&sc->sc_log, 0, &node, &ssnode,
799 CTLFLAG_READWRITE, CTLTYPE_INT, "speedstep_state", NULL,
800 speedstep_sysctl_helper, 0, NULL, 0, CTL_CREATE,
801 CTL_EOL)) != 0)
802 goto err;
803
804 /* XXX save the sc for IO tag/handle */
805 speedstep_cookie = sc;
806 aprint_verbose_dev(self, "SpeedStep enabled\n");
807 }
808
809 return;
810
811 err:
812 aprint_normal("%s: sysctl_createv failed (rv = %d)\n", __func__, rv);
813 }
814
815 static void
816 speedstep_unconfigure(device_t self)
817 {
818 struct lpcib_softc *sc = device_private(self);
819
820 sysctl_teardown(&sc->sc_log);
821 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
822 LPCIB_PCI_GEN_PMCON_1, sc->sc_pmcon_orig);
823
824 speedstep_cookie = NULL;
825 }
826
827 /*
828 * get/set the SpeedStep state: 0 == low power, 1 == high power.
829 */
830 static int
831 speedstep_sysctl_helper(SYSCTLFN_ARGS)
832 {
833 struct sysctlnode node;
834 struct lpcib_softc *sc = speedstep_cookie;
835 uint8_t state, state2;
836 int ostate, nstate, s, error = 0;
837
838 /*
839 * We do the dance with spl's to avoid being at high ipl during
840 * sysctl_lookup() which can both copyin and copyout.
841 */
842 s = splserial();
843 state = SS_READ(sc, LPCIB_PM_SS_CNTL);
844 splx(s);
845 if ((state & LPCIB_PM_SS_STATE_LOW) == 0)
846 ostate = 1;
847 else
848 ostate = 0;
849 nstate = ostate;
850
851 node = *rnode;
852 node.sysctl_data = &nstate;
853
854 error = sysctl_lookup(SYSCTLFN_CALL(&node));
855 if (error || newp == NULL)
856 goto out;
857
858 /* Only two states are available */
859 if (nstate != 0 && nstate != 1) {
860 error = EINVAL;
861 goto out;
862 }
863
864 s = splserial();
865 state2 = SS_READ(sc, LPCIB_PM_SS_CNTL);
866 if ((state2 & LPCIB_PM_SS_STATE_LOW) == 0)
867 ostate = 1;
868 else
869 ostate = 0;
870
871 if (ostate != nstate) {
872 uint8_t cntl;
873
874 if (nstate == 0)
875 state2 |= LPCIB_PM_SS_STATE_LOW;
876 else
877 state2 &= ~LPCIB_PM_SS_STATE_LOW;
878
879 /*
880 * Must disable bus master arbitration during the change.
881 */
882 cntl = SS_READ(sc, LPCIB_PM_CTRL);
883 SS_WRITE(sc, LPCIB_PM_CTRL, cntl | LPCIB_PM_SS_CNTL_ARB_DIS);
884 SS_WRITE(sc, LPCIB_PM_SS_CNTL, state2);
885 SS_WRITE(sc, LPCIB_PM_CTRL, cntl);
886 }
887 splx(s);
888 out:
889 return error;
890 }
891
892 #if NHPET > 0
893 struct lpcib_hpet_attach_arg {
894 bus_space_tag_t hpet_mem_t;
895 uint32_t hpet_reg;
896 };
897
898 static int
899 lpcib_hpet_match(device_t parent, cfdata_t match, void *aux)
900 {
901 struct lpcib_hpet_attach_arg *arg = aux;
902 bus_space_tag_t tag;
903 bus_space_handle_t handle;
904
905 tag = arg->hpet_mem_t;
906
907 if (bus_space_map(tag, arg->hpet_reg, HPET_WINDOW_SIZE, 0, &handle)) {
908 aprint_verbose_dev(parent, "HPET window not mapped, skipping\n");
909 return 0;
910 }
911 bus_space_unmap(tag, handle, HPET_WINDOW_SIZE);
912
913 return 1;
914 }
915
916 static int
917 lpcib_hpet_detach(device_t self, int flags)
918 {
919 struct hpet_softc *sc = device_private(self);
920 int rc;
921
922 if ((rc = hpet_detach(self, flags)) != 0)
923 return rc;
924
925 bus_space_unmap(sc->sc_memt, sc->sc_memh, HPET_WINDOW_SIZE);
926
927 return 0;
928 }
929
930 static void
931 lpcib_hpet_attach(device_t parent, device_t self, void *aux)
932 {
933 struct hpet_softc *sc = device_private(self);
934 struct lpcib_hpet_attach_arg *arg = aux;
935
936 aprint_naive("\n");
937 aprint_normal("\n");
938
939 sc->sc_memt = arg->hpet_mem_t;
940
941 if (bus_space_map(sc->sc_memt, arg->hpet_reg, HPET_WINDOW_SIZE, 0,
942 &sc->sc_memh)) {
943 aprint_error_dev(self,
944 "HPET memory window could not be mapped");
945 return;
946 }
947
948 hpet_attach_subr(self);
949 }
950
951 CFATTACH_DECL_NEW(ichlpcib_hpet, sizeof(struct hpet_softc), lpcib_hpet_match,
952 lpcib_hpet_attach, lpcib_hpet_detach, NULL);
953
954 static void
955 lpcib_hpet_configure(device_t self)
956 {
957 struct lpcib_softc *sc = device_private(self);
958 struct lpcib_hpet_attach_arg arg;
959 uint32_t hpet_reg, val;
960
961 if (sc->sc_has_ich5_hpet) {
962 val = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
963 LPCIB_PCI_GEN_CNTL);
964 switch (val & LPCIB_ICH5_HPTC_WIN_MASK) {
965 case LPCIB_ICH5_HPTC_0000:
966 hpet_reg = LPCIB_ICH5_HPTC_0000_BASE;
967 break;
968 case LPCIB_ICH5_HPTC_1000:
969 hpet_reg = LPCIB_ICH5_HPTC_1000_BASE;
970 break;
971 case LPCIB_ICH5_HPTC_2000:
972 hpet_reg = LPCIB_ICH5_HPTC_2000_BASE;
973 break;
974 case LPCIB_ICH5_HPTC_3000:
975 hpet_reg = LPCIB_ICH5_HPTC_3000_BASE;
976 break;
977 default:
978 return;
979 }
980 val |= sc->sc_hpet_reg | LPCIB_ICH5_HPTC_EN;
981 pci_conf_write(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
982 LPCIB_PCI_GEN_CNTL, val);
983 } else if (sc->sc_has_rcba) {
984 val = bus_space_read_4(sc->sc_rcbat, sc->sc_rcbah,
985 LPCIB_RCBA_HPTC);
986 switch (val & LPCIB_RCBA_HPTC_WIN_MASK) {
987 case LPCIB_RCBA_HPTC_0000:
988 hpet_reg = LPCIB_RCBA_HPTC_0000_BASE;
989 break;
990 case LPCIB_RCBA_HPTC_1000:
991 hpet_reg = LPCIB_RCBA_HPTC_1000_BASE;
992 break;
993 case LPCIB_RCBA_HPTC_2000:
994 hpet_reg = LPCIB_RCBA_HPTC_2000_BASE;
995 break;
996 case LPCIB_RCBA_HPTC_3000:
997 hpet_reg = LPCIB_RCBA_HPTC_3000_BASE;
998 break;
999 default:
1000 return;
1001 }
1002 val |= LPCIB_RCBA_HPTC_EN;
1003 bus_space_write_4(sc->sc_rcbat, sc->sc_rcbah, LPCIB_RCBA_HPTC,
1004 val);
1005 } else {
1006 /* No HPET here */
1007 return;
1008 }
1009
1010 arg.hpet_mem_t = sc->sc_pa.pa_memt;
1011 arg.hpet_reg = hpet_reg;
1012
1013 sc->sc_hpetbus = config_found_ia(self, "hpetichbus", &arg, NULL);
1014 }
1015
1016 static int
1017 lpcib_hpet_unconfigure(device_t self, int flags)
1018 {
1019 struct lpcib_softc *sc = device_private(self);
1020 int rc;
1021
1022 if (sc->sc_hpetbus != NULL &&
1023 (rc = config_detach(sc->sc_hpetbus, flags)) != 0)
1024 return rc;
1025
1026 return 0;
1027 }
1028 #endif
1029
1030 #if NGPIO > 0
1031 static void
1032 lpcib_gpio_configure(device_t self)
1033 {
1034 struct lpcib_softc *sc = device_private(self);
1035 struct gpiobus_attach_args gba;
1036 pcireg_t gpio_cntl;
1037 uint32_t use, io, bit;
1038 int pin, shift, base_reg, cntl_reg, reg;
1039
1040 /* this implies ICH >= 6, and thus different mapreg */
1041 if (sc->sc_has_rcba) {
1042 base_reg = LPCIB_PCI_GPIO_BASE_ICH6;
1043 cntl_reg = LPCIB_PCI_GPIO_CNTL_ICH6;
1044 } else {
1045 base_reg = LPCIB_PCI_GPIO_BASE;
1046 cntl_reg = LPCIB_PCI_GPIO_CNTL;
1047 }
1048
1049 gpio_cntl = pci_conf_read(sc->sc_pcib.sc_pc, sc->sc_pcib.sc_tag,
1050 cntl_reg);
1051
1052 /* Is GPIO enabled? */
1053 if ((gpio_cntl & LPCIB_PCI_GPIO_CNTL_EN) == 0)
1054 return;
1055
1056 if (pci_mapreg_map(&sc->sc_pa, base_reg, PCI_MAPREG_TYPE_IO, 0,
1057 &sc->sc_gpio_iot, &sc->sc_gpio_ioh,
1058 NULL, &sc->sc_gpio_ios)) {
1059 aprint_error_dev(self, "can't map general purpose i/o space\n");
1060 return;
1061 }
1062
1063 mutex_init(&sc->sc_gpio_mtx, MUTEX_DEFAULT, IPL_NONE);
1064
1065 for (pin = 0; pin < LPCIB_GPIO_NPINS; pin++) {
1066 sc->sc_gpio_pins[pin].pin_num = pin;
1067
1068 /* Read initial state */
1069 reg = (pin < 32) ? LPCIB_GPIO_GPIO_USE_SEL : LPCIB_GPIO_GPIO_USE_SEL2;
1070 use = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg);
1071 reg = (pin < 32) ? LPCIB_GPIO_GP_IO_SEL : LPCIB_GPIO_GP_IO_SEL;
1072 io = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, 4);
1073 shift = pin % 32;
1074 bit = __BIT(shift);
1075
1076 if ((use & bit) != 0) {
1077 sc->sc_gpio_pins[pin].pin_caps =
1078 GPIO_PIN_INPUT | GPIO_PIN_OUTPUT;
1079 if (pin < 32)
1080 sc->sc_gpio_pins[pin].pin_caps |=
1081 GPIO_PIN_PULSATE;
1082 if ((io & bit) != 0)
1083 sc->sc_gpio_pins[pin].pin_flags =
1084 GPIO_PIN_INPUT;
1085 else
1086 sc->sc_gpio_pins[pin].pin_flags =
1087 GPIO_PIN_OUTPUT;
1088 } else
1089 sc->sc_gpio_pins[pin].pin_caps = 0;
1090
1091 if (lpcib_gpio_pin_read(sc, pin) == 0)
1092 sc->sc_gpio_pins[pin].pin_state = GPIO_PIN_LOW;
1093 else
1094 sc->sc_gpio_pins[pin].pin_state = GPIO_PIN_HIGH;
1095
1096 }
1097
1098 /* Create controller tag */
1099 sc->sc_gpio_gc.gp_cookie = sc;
1100 sc->sc_gpio_gc.gp_pin_read = lpcib_gpio_pin_read;
1101 sc->sc_gpio_gc.gp_pin_write = lpcib_gpio_pin_write;
1102 sc->sc_gpio_gc.gp_pin_ctl = lpcib_gpio_pin_ctl;
1103
1104 memset(&gba, 0, sizeof(gba));
1105
1106 gba.gba_gc = &sc->sc_gpio_gc;
1107 gba.gba_pins = sc->sc_gpio_pins;
1108 gba.gba_npins = LPCIB_GPIO_NPINS;
1109
1110 sc->sc_gpiobus = config_found_ia(self, "gpiobus", &gba, gpiobus_print);
1111 }
1112
1113 static int
1114 lpcib_gpio_unconfigure(device_t self, int flags)
1115 {
1116 struct lpcib_softc *sc = device_private(self);
1117 int rc;
1118
1119 if (sc->sc_gpiobus != NULL &&
1120 (rc = config_detach(sc->sc_gpiobus, flags)) != 0)
1121 return rc;
1122
1123 mutex_destroy(&sc->sc_gpio_mtx);
1124
1125 bus_space_unmap(sc->sc_gpio_iot, sc->sc_gpio_ioh, sc->sc_gpio_ios);
1126
1127 return 0;
1128 }
1129
1130 static int
1131 lpcib_gpio_pin_read(void *arg, int pin)
1132 {
1133 struct lpcib_softc *sc = arg;
1134 uint32_t data;
1135 int reg, shift;
1136
1137 reg = (pin < 32) ? LPCIB_GPIO_GP_LVL : LPCIB_GPIO_GP_LVL2;
1138 shift = pin % 32;
1139
1140 mutex_enter(&sc->sc_gpio_mtx);
1141 data = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg);
1142 mutex_exit(&sc->sc_gpio_mtx);
1143
1144 return (__SHIFTOUT(data, __BIT(shift)) ? GPIO_PIN_HIGH : GPIO_PIN_LOW);
1145 }
1146
1147 static void
1148 lpcib_gpio_pin_write(void *arg, int pin, int value)
1149 {
1150 struct lpcib_softc *sc = arg;
1151 uint32_t data;
1152 int reg, shift;
1153
1154 reg = (pin < 32) ? LPCIB_GPIO_GP_LVL : LPCIB_GPIO_GP_LVL2;
1155 shift = pin % 32;
1156
1157 mutex_enter(&sc->sc_gpio_mtx);
1158
1159 data = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg);
1160
1161 if(value)
1162 data |= __BIT(shift);
1163 else
1164 data &= ~__BIT(shift);
1165
1166 bus_space_write_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg, data);
1167
1168 mutex_exit(&sc->sc_gpio_mtx);
1169 }
1170
1171 static void
1172 lpcib_gpio_pin_ctl(void *arg, int pin, int flags)
1173 {
1174 struct lpcib_softc *sc = arg;
1175 uint32_t data;
1176 int reg, shift;
1177
1178 shift = pin % 32;
1179 reg = (pin < 32) ? LPCIB_GPIO_GP_IO_SEL : LPCIB_GPIO_GP_IO_SEL2;
1180
1181 mutex_enter(&sc->sc_gpio_mtx);
1182
1183 data = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg);
1184
1185 if (flags & GPIO_PIN_OUTPUT)
1186 data &= ~__BIT(shift);
1187
1188 if (flags & GPIO_PIN_INPUT)
1189 data |= __BIT(shift);
1190
1191 bus_space_write_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg, data);
1192
1193
1194 if (pin < 32) {
1195 reg = LPCIB_GPIO_GPO_BLINK;
1196 data = bus_space_read_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg);
1197
1198 if (flags & GPIO_PIN_PULSATE)
1199 data |= __BIT(shift);
1200 else
1201 data &= ~__BIT(shift);
1202
1203 bus_space_write_4(sc->sc_gpio_iot, sc->sc_gpio_ioh, reg, data);
1204 }
1205
1206 mutex_exit(&sc->sc_gpio_mtx);
1207 }
1208 #endif
1209