1 /* $Id: mpcsa_cf.c,v 1.2 2008/07/03 01:15:39 matt Exp $ */ 2 /* $NetBSD: mpcsa_cf.c,v 1.2 2008/07/03 01:15:39 matt Exp $ */ 3 4 /* 5 * Copyright (c) 2007 Embedtronics Oy. All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: mpcsa_cf.c,v 1.2 2008/07/03 01:15:39 matt Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/kernel.h> 35 #include <sys/device.h> 36 #include <arm/at91/at91reg.h> 37 #include <arm/at91/at91var.h> 38 #include <arm/at91/at91cfvar.h> 39 #include <arm/at91/at91piovar.h> 40 41 #ifdef MPCA_CF_DEBUG 42 int mpcsa_cf_debug = MPCA_CF_DEBUG; 43 #define DPRINTFN(n,x) if (mpcsa_cf_debug>(n)) printf x; 44 #else 45 #define DPRINTFN(n,x) 46 #endif 47 48 struct at91_gpio_softc; 49 50 struct mpcsa_cf_softc { 51 struct at91cf_softc sc_dev; 52 struct at91pio_softc *sc_pioc; 53 }; 54 55 static int mpcsa_cf_match(struct device *, struct cfdata *, void *); 56 static void mpcsa_cf_attach(struct device *, struct device *, void *); 57 58 CFATTACH_DECL_NEW(mpcsa_cf, sizeof(struct mpcsa_cf_softc), 59 mpcsa_cf_match, mpcsa_cf_attach, NULL, NULL); 60 61 static int mpcsa_cf_power_ctl(void *self, int onoff); 62 static int mpcsa_cf_card_detect(void *self); 63 static int mpcsa_cf_irq_line(void *self); 64 static void * mpcsa_cf_intr_establish(void *self, int which, int ipl, int (*ih_func)(void *), void *arg); 65 static void mpcsa_cf_intr_disestablish(void *self, int which, void *cookie); 66 67 struct at91cf_chipset_tag mpcsa_cf_tag = { 68 mpcsa_cf_power_ctl, 69 mpcsa_cf_card_detect, 70 mpcsa_cf_irq_line, 71 mpcsa_cf_intr_establish, 72 mpcsa_cf_intr_disestablish 73 }; 74 75 static int 76 mpcsa_cf_match(struct device *parent, struct cfdata *match, void *aux) 77 { 78 if (strcmp(match->cf_name, "at91cf") == 0 && strcmp(match->cf_atname, "mpcsa_cf") == 0) 79 return 2; 80 return 0; 81 } 82 83 static void 84 mpcsa_cf_attach(struct device *parent, struct device *self, void *aux) 85 { 86 struct mpcsa_cf_softc *sc = device_private(self); 87 // at91cf_chipset_tag_t cscf = sc->sc_dev.sc_cscf; 88 struct at91pio_softc *pioc; 89 90 if ((pioc = at91pio_sc(AT91_PIOC)) == NULL) { 91 printf("no PIOC!\n"); 92 return; 93 } 94 95 // configure PIO! 96 sc->sc_pioc = pioc; 97 at91pio_in(sc->sc_pioc, 3); // CFIRQ 98 at91pio_in(sc->sc_pioc, 4); // CFCD 99 at91pio_out(sc->sc_pioc, 5); // CFRESET 100 101 // and call common routine 102 at91cf_attach_common(parent, self, aux, &mpcsa_cf_tag); 103 } 104 105 static int 106 mpcsa_cf_power_ctl(void *self, int onoff) 107 { 108 struct mpcsa_cf_softc *sc = self; 109 if (onoff) { 110 at91pio_set(sc->sc_pioc, 5); 111 return 20000; 112 } else { 113 at91pio_clear(sc->sc_pioc, 5); 114 return 20000; 115 } 116 } 117 118 static int mpcsa_cf_card_detect(void *self) 119 { 120 struct mpcsa_cf_softc *sc = self; 121 return at91pio_read(sc->sc_pioc, 4) == 0; 122 } 123 124 static int mpcsa_cf_irq_line(void *self) 125 { 126 struct mpcsa_cf_softc *sc = self; 127 return at91pio_read(sc->sc_pioc, 3); 128 } 129 130 static void * mpcsa_cf_intr_establish(void *self, int which, int ipl, int (*ih_func)(void *), void *ih_arg) 131 { 132 struct mpcsa_cf_softc *sc = self; 133 return at91pio_intr_establish(sc->sc_pioc, which == CD_IRQ ? 4 : 3, 134 ipl, ih_func, ih_arg); 135 } 136 137 static void mpcsa_cf_intr_disestablish(void *self, int which, void *cookie) 138 { 139 struct mpcsa_cf_softc *sc = self; 140 at91pio_intr_disestablish(sc->sc_pioc, which == CD_IRQ ? 4 : 3, cookie); 141 } 142 143