at91pio.c revision 1.4
1 /* $Id: at91pio.c,v 1.4 2011/07/01 19:31:17 dyoung Exp $ */ 2 /* $NetBSD: at91pio.c,v 1.4 2011/07/01 19:31:17 dyoung Exp $ */ 3 4 /* 5 * Copyright (c) 2007 Embedtronics Oy. All rights reserved. 6 * 7 * Based on arch/arm/ep93xx/epgpio.c, 8 * Copyright (c) 2005 HAMAJIMA Katsuomi. All rights reserved. 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 AUTHOR AND CONTRIBUTORS ``AS IS'' AND 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 * SUCH DAMAGE. 30 */ 31 32 #include <sys/cdefs.h> 33 __KERNEL_RCSID(0, "$NetBSD: at91pio.c,v 1.4 2011/07/01 19:31:17 dyoung Exp $"); 34 35 #include <sys/param.h> 36 #include <sys/systm.h> 37 #include <sys/kernel.h> 38 #include <sys/device.h> 39 #include <sys/gpio.h> 40 #include <sys/bus.h> 41 #include <machine/intr.h> 42 #include <dev/gpio/gpiovar.h> 43 #include <arm/at91/at91var.h> 44 #include <arm/at91/at91reg.h> 45 #include <arm/at91/at91pioreg.h> 46 #include <arm/at91/at91piovar.h> 47 #include "gpio.h" 48 #if NGPIO > 0 49 #include <sys/gpio.h> 50 #endif 51 #include "locators.h" 52 53 #ifdef AT91PIO_DEBUG 54 int at91pio_debug = AT91PIO_DEBUG; 55 #define DPRINTFN(n,x) if (at91pio_debug>(n)) printf x; 56 #else 57 #define DPRINTFN(n,x) 58 #endif 59 60 #define AT91PIO_NMAXPORTS 4 61 #define AT91PIO_NPINS 32 62 63 struct intr_req { 64 int (*ireq_func)(void *); 65 void *ireq_arg; 66 int ireq_ipl; 67 }; 68 69 #define PIO_READ(_sc, _reg) bus_space_read_4((_sc)->sc_iot, (_sc)->sc_ioh, (_reg)) 70 #define PIO_WRITE(_sc, _reg, _val) bus_space_write_4((_sc)->sc_iot, (_sc)->sc_ioh, (_reg), (_val)) 71 72 struct at91pio_softc { 73 struct device sc_dev; 74 bus_space_tag_t sc_iot; 75 bus_space_handle_t sc_ioh; 76 int sc_pid; 77 #if NGPIO > 0 78 struct gpio_chipset_tag gpio_chipset; 79 gpio_pin_t pins[AT91PIO_NPINS]; 80 #endif 81 int irq; 82 void *ih; 83 struct intr_req ireq[AT91PIO_NPINS]; 84 }; 85 86 static int at91pio_match(device_t, cfdata_t, void *); 87 static void at91pio_attach(device_t, device_t, void *); 88 89 #if NGPIO > 0 90 static int at91piobus_print(void *, const char *); 91 static int at91pio_pin_read(void *, int); 92 static void at91pio_pin_write(void *, int, int); 93 static void at91pio_pin_ctl(void *, int, int); 94 #endif 95 96 static int at91pio_search(device_t, cfdata_t, const int *, void *); 97 static int at91pio_print(void *, const char *); 98 99 static int at91pio_intr(void* arg); 100 101 CFATTACH_DECL(at91pio, sizeof(struct at91pio_softc), 102 at91pio_match, at91pio_attach, NULL, NULL); 103 104 static struct at91pio_softc *at91pio_softc[AT91_PIO_COUNT]; 105 106 struct at91pio_softc *at91pio_sc(at91pio_port port) 107 { 108 if (port < AT91_PIO_COUNT) 109 return at91pio_softc[port]; 110 return NULL; 111 } 112 113 114 static int 115 at91pio_match(device_t parent, cfdata_t match, void *aux) 116 { 117 if (strcmp(match->cf_name, "at91pio") == 0) 118 return 2; 119 return 0; 120 } 121 122 static void 123 at91pio_attach(device_t parent, device_t self, void *aux) 124 { 125 struct at91pio_softc *sc = (struct at91pio_softc*)self; 126 struct at91bus_attach_args *sa = aux; 127 #if NGPIO > 0 128 struct gpiobus_attach_args gba; 129 uint32_t psr, osr, pin; 130 int j, n; 131 #endif 132 printf("\n"); 133 sc->sc_iot = sa->sa_iot; 134 sc->sc_pid = sa->sa_pid; 135 136 if (bus_space_map(sa->sa_iot, sa->sa_addr, 137 sa->sa_size, 0, &sc->sc_ioh)){ 138 printf("%s: Cannot map registers", self->dv_xname); 139 return; 140 } 141 142 /* save descriptor: */ 143 at91pio_port p = at91_pio_port(sa->sa_pid); 144 if (p < AT91_PIO_COUNT && !at91pio_softc[p]) 145 at91pio_softc[p] = sc; 146 147 /* make sure peripheral is enabled: */ 148 at91_peripheral_clock(sc->sc_pid, 1); 149 150 /* initialize ports (disable interrupts) */ 151 PIO_WRITE(sc, PIO_IDR, -1); 152 153 #if NGPIO > 0 154 /* initialize and attach gpio(4) */ 155 psr = PIO_READ(sc, PIO_PSR); // only ports 156 osr = PIO_READ(sc, PIO_OSR); 157 pin = PIO_READ(sc, PIO_PDSR); 158 psr &= ~at91_gpio_mask(sc->sc_pid); 159 for (j = n = 0; j < AT91PIO_NPINS; j++) { 160 sc->pins[n].pin_num = j; 161 if (psr & (1 << j)) 162 sc->pins[n].pin_caps = (GPIO_PIN_INPUT 163 | GPIO_PIN_OUTPUT 164 | GPIO_PIN_OPENDRAIN // @@@ not all pins 165 | GPIO_PIN_PUSHPULL 166 | GPIO_PIN_PULLUP); 167 else 168 sc->pins[n].pin_caps = 0; 169 170 if (osr & (1 << j)) 171 sc->pins[n].pin_flags = GPIO_PIN_OUTPUT; 172 else 173 sc->pins[n].pin_flags = GPIO_PIN_INPUT; 174 if (pin & (1 << j)) 175 sc->pins[n].pin_state = GPIO_PIN_HIGH; 176 else 177 sc->pins[n].pin_state = GPIO_PIN_LOW; 178 n++; 179 } 180 sc->gpio_chipset.gp_cookie = sc; 181 sc->gpio_chipset.gp_pin_read = at91pio_pin_read; 182 sc->gpio_chipset.gp_pin_write = at91pio_pin_write; 183 sc->gpio_chipset.gp_pin_ctl = at91pio_pin_ctl; 184 gba.gba_gc = &sc->gpio_chipset; 185 gba.gba_pins = sc->pins; 186 gba.gba_npins = n; 187 config_found_ia(self, "gpiobus", &gba, at91piobus_print); 188 #endif 189 190 /* attach device */ 191 config_search_ia(at91pio_search, self, "at91pio", at91pio_print); 192 } 193 194 #if NGPIO > 0 195 static int 196 at91piobus_print(void *aux, const char *name) 197 { 198 struct gpiobus_attach_args *gba = aux; 199 struct at91pio_softc *sc = (struct at91pio_softc *)gba->gba_gc->gp_cookie; 200 201 gpiobus_print(aux, name); 202 aprint_normal(": port %s (mask %08"PRIX32")", 203 at91_peripheral_name(sc->sc_pid), 204 at91_gpio_mask(sc->sc_pid)); 205 206 return (UNCONF); 207 } 208 #endif 209 210 211 static int 212 at91pio_search(device_t parent, cfdata_t cf, 213 const int *ldesc, void *aux) 214 { 215 struct at91pio_softc *sc = (struct at91pio_softc*)parent; 216 struct at91pio_attach_args paa; 217 218 paa.paa_sc = sc; 219 paa.paa_iot = sc->sc_iot; 220 paa.paa_pid = cf->cf_loc[AT91PIOCF_PID]; 221 paa.paa_bit = cf->cf_loc[AT91PIOCF_BIT]; 222 223 if (config_match(parent, cf, &paa) > 0) 224 config_attach(parent, cf, &paa, at91pio_print); 225 226 return 0; 227 } 228 229 static int 230 at91pio_print(void *aux, const char *name) 231 { 232 struct at91pio_attach_args *paa = (struct at91pio_attach_args*)aux; 233 // struct at91pio_softc *sc = (struct at91pio_softc*)paa->paa_sc; 234 235 aprint_normal(":"); 236 if (paa->paa_pid > -1) 237 aprint_normal(" port %s", at91_peripheral_name(paa->paa_pid)); 238 if (paa->paa_bit > -1) 239 aprint_normal(" bit %d", paa->paa_bit); 240 241 return (UNCONF); 242 } 243 244 int 245 at91pio_read(struct at91pio_softc *sc, int bit) 246 { 247 #if NGPIO > 0 248 sc->pins[bit].pin_caps = 0; 249 #endif 250 return (PIO_READ(sc, PIO_PDSR) >> bit) & 1; 251 } 252 253 void 254 at91pio_set(struct at91pio_softc *sc, int bit) 255 { 256 #if NGPIO > 0 257 sc->pins[bit].pin_caps = 0; 258 #endif 259 PIO_WRITE(sc, PIO_SODR, (1U << bit)); 260 } 261 262 void 263 at91pio_clear(struct at91pio_softc *sc, int bit) 264 { 265 #if NGPIO > 0 266 sc->pins[bit].pin_caps = 0; 267 #endif 268 PIO_WRITE(sc, PIO_CODR, (1U << bit)); 269 } 270 271 void 272 at91pio_in(struct at91pio_softc *sc, int bit) 273 { 274 #if NGPIO > 0 275 sc->pins[bit].pin_caps = 0; 276 #endif 277 PIO_WRITE(sc, PIO_ODR, (1U << bit)); 278 } 279 280 void 281 at91pio_out(struct at91pio_softc *sc, int bit) 282 { 283 #if NGPIO > 0 284 sc->pins[bit].pin_caps = 0; 285 #endif 286 PIO_WRITE(sc, PIO_OER, (1U << bit)); 287 } 288 289 void at91pio_per(struct at91pio_softc *sc, int bit, int perab) 290 { 291 #if NGPIO > 0 292 sc->pins[bit].pin_caps = 0; 293 #endif 294 switch (perab) { 295 case -1: 296 PIO_WRITE(sc, PIO_PER, (1U << bit)); 297 break; 298 case 0: 299 PIO_WRITE(sc, PIO_ASR, (1U << bit)); 300 PIO_WRITE(sc, PIO_PDR, (1U << bit)); 301 break; 302 case 1: 303 PIO_WRITE(sc, PIO_BSR, (1U << bit)); 304 PIO_WRITE(sc, PIO_PDR, (1U << bit)); 305 break; 306 default: 307 panic("%s: perab is invalid: %i", __FUNCTION__, perab); 308 break; 309 } 310 } 311 312 void * 313 at91pio_intr_establish(struct at91pio_softc *sc, int bit, 314 int ipl, int (*ireq_func)(void *), void *arg) 315 { 316 struct intr_req *ireq; 317 318 DPRINTFN(1, ("at91pio_intr_establish: port=%s, bit=%d\n", at91_peripheral_name(sc->sc_pid), bit)); 319 320 if (bit < 0 || bit >= AT91PIO_NPINS) 321 return 0; 322 323 ireq = &sc->ireq[bit]; 324 325 if (ireq->ireq_func) /* already used */ 326 return 0; 327 328 ireq->ireq_func = ireq_func; 329 ireq->ireq_arg = arg; 330 ireq->ireq_ipl = ipl; 331 332 PIO_WRITE(sc, PIO_IDR, (1U << bit)); /* disable interrupt for now */ 333 at91pio_in(sc, bit); /* make sure pin is input */ 334 #if NGPIO > 0 335 sc->pins[bit].pin_caps = 0; 336 #endif 337 #if 0 338 if (flag & EDGE_TRIGGER) 339 at91pio_bit_set(sc, sc->xinttype1, bit); 340 else /* LEVEL_SENSE */ 341 at91pio_bit_clear(sc, sc->xinttype1, bit); 342 if (flag & RISING_EDGE) /* or HIGH_LEVEL */ 343 at91pio_bit_set(sc, sc->xinttype2, bit); 344 else /* FALLING_EDGE or LOW_LEVEL */ 345 at91pio_bit_clear(sc, sc->xinttype2, bit); 346 if (flag & DEBOUNCE) 347 PIO_WRITE(sc, PIO_IFER, (1U << bit)); 348 else 349 PIO_WRITE(sc, PIO_IFDR, (1U << bit)); 350 #endif 351 352 if (!sc->ih) { 353 // use IPL_BIO because we want lowest possible priority as 354 // we really don't know what priority is going to be used by 355 // the caller.. this is not really optimal but tell me a 356 // better way 357 sc->ih = at91_intr_establish(sc->sc_pid, IPL_BIO, INTR_HIGH_LEVEL, 358 at91pio_intr, sc); 359 } 360 361 //(void)PIO_READ(sc, PIO_ISR); // clear interrupts 362 PIO_WRITE(sc, PIO_IER, (1U << bit)); // enable interrupt 363 364 return sc->ih; 365 } 366 367 void 368 at91pio_intr_disestablish(struct at91pio_softc *sc, int bit, void *cookie) 369 { 370 struct intr_req *ireq; 371 int i; 372 373 DPRINTFN(1, ("at91pio_intr_disestablish: port=%s, bit=%d\n", at91_peripheral_name(sc->sc_pid), bit)); 374 375 if (bit < 0 || bit >= AT91PIO_NPINS) 376 return; 377 378 if (cookie != sc->ih) 379 return; 380 381 ireq = &sc->ireq[bit]; 382 383 if (!ireq->ireq_func) 384 return; 385 386 PIO_WRITE(sc, PIO_IDR, (1U << bit)); 387 ireq->ireq_func = 0; 388 ireq->ireq_arg = 0; 389 390 for (i = 0; i < AT91PIO_NPINS; i++) { 391 if (sc->ireq[i].ireq_func) 392 break; 393 } 394 395 if (i >= AT91PIO_NPINS) { 396 at91_intr_disestablish(sc->ih); 397 sc->ih = 0; 398 } 399 } 400 401 static int 402 at91pio_intr(void *arg) 403 { 404 struct at91pio_softc *sc = arg; 405 int bit; 406 u_int32_t isr; 407 408 isr = (PIO_READ(sc, PIO_ISR) & PIO_READ(sc, PIO_IMR)); 409 if (!isr) 410 return 0; 411 412 do { 413 bit = ffs(isr) - 1; 414 isr &= ~(1U << bit); 415 #ifdef DIAGNOSTIC 416 if (bit < 0) 417 panic("%s: isr is zero (0x%X)", __FUNCTION__, isr); 418 #endif 419 if (sc->ireq[bit].ireq_func) { 420 int s = _splraise(sc->ireq[bit].ireq_ipl); 421 (*sc->ireq[bit].ireq_func)(sc->ireq[bit].ireq_arg); 422 splx(s); 423 } 424 } while (isr); 425 426 return 1; 427 } 428 429 430 #if NGPIO > 0 431 static int 432 at91pio_pin_read(void *arg, int pin) 433 { 434 struct at91pio_softc *sc = arg; 435 436 pin %= AT91PIO_NPINS; 437 if (!sc->pins[pin].pin_caps) 438 return 0; /* EBUSY? */ 439 440 return (PIO_READ(sc, PIO_PDSR) >> pin) & 1; 441 } 442 443 static void 444 at91pio_pin_write(void *arg, int pin, int val) 445 { 446 struct at91pio_softc *sc = arg; 447 448 pin %= AT91PIO_NPINS; 449 if (!sc->pins[pin].pin_caps) 450 return; 451 452 if (val) 453 PIO_WRITE(sc, PIO_SODR, (1U << pin)); 454 else 455 PIO_WRITE(sc, PIO_CODR, (1U << pin)); 456 } 457 458 static void 459 at91pio_pin_ctl(void *arg, int pin, int flags) 460 { 461 struct at91pio_softc *sc = arg; 462 463 pin %= AT91PIO_NPINS; 464 if (!sc->pins[pin].pin_caps) 465 return; 466 467 if (flags & GPIO_PIN_INPUT) 468 PIO_WRITE(sc, PIO_ODR, (1U << pin)); 469 else if (flags & GPIO_PIN_OUTPUT) 470 PIO_WRITE(sc, PIO_OER, (1U << pin)); 471 472 if (flags & GPIO_PIN_OPENDRAIN) 473 PIO_WRITE(sc, PIO_MDER, (1U << pin)); 474 else if (flags & GPIO_PIN_PUSHPULL) 475 PIO_WRITE(sc, PIO_MDDR, (1U << pin)); 476 477 if (flags & GPIO_PIN_PULLUP) 478 PIO_WRITE(sc, PIO_PUER, (1U << pin)); 479 else 480 PIO_WRITE(sc, PIO_PUDR, (1U << pin)); 481 } 482 #endif 483 484
Indexes created Wed Sep 24 05:09:52 GMT 2025