Home | History | Annotate | Line # | Download | only in mpcsa
mpcsa_usart.c revision 1.3
      1 /*	$Id: mpcsa_usart.c,v 1.3 2011/05/13 22:35:50 rmind Exp $	*/
      2 /*	$NetBSD: mpcsa_usart.c,v 1.3 2011/05/13 22:35:50 rmind 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_usart.c,v 1.3 2011/05/13 22:35:50 rmind Exp $");
     31 
     32 #include <sys/types.h>
     33 #include <sys/param.h>
     34 #include <sys/systm.h>
     35 #include <sys/kernel.h>
     36 #include <sys/device.h>
     37 #include <sys/proc.h>
     38 #include <arm/at91/at91reg.h>
     39 #include <arm/at91/at91var.h>
     40 #include <arm/at91/at91usartvar.h>
     41 #include <arm/at91/at91piovar.h>
     42 #include <arm/at91/at91rm9200reg.h>
     43 #include <evbarm/mpcsa/mpcsa_io.h>
     44 #include <evbarm/mpcsa/mpcsa_leds_var.h>
     45 #include <sys/unistd.h>
     46 
     47 #ifdef MPCSA_USART_DEBUG
     48 int mpcsa_usart_debug = MPCSA_USART_DEBUG;
     49 #define DPRINTFN(n,x)	if (mpcsa_usart_debug>(n)) printf x;
     50 #else
     51 #define DPRINTFN(n,x)
     52 #endif
     53 
     54 struct at91pio_softc;
     55 
     56 struct mpcsa_usart_softc {
     57 	struct at91usart_softc	sc_dev;
     58 	struct at91pio_softc	*sc_pioa, *sc_piob, *sc_piod;
     59 	void *sc_cts_ih;
     60 	int sc_tx_busy, sc_rx_busy;
     61 };
     62 
     63 static int mpcsa_usart_match(struct device *, struct cfdata *, void *);
     64 static void mpcsa_usart_attach(struct device *, struct device *, void *);
     65 
     66 CFATTACH_DECL(mpcsa_usart, sizeof(struct mpcsa_usart_softc),
     67 	      mpcsa_usart_match, mpcsa_usart_attach, NULL, NULL);
     68 
     69 static int mpcsa_usart_enable(struct at91usart_softc *sc);
     70 static int mpcsa_usart_disable(struct at91usart_softc *sc);
     71 static void mpcsa_usart_hwflow(struct at91usart_softc *sc, int cflags);
     72 static void mpcsa_usart_start_tx(struct at91usart_softc *sc);
     73 static void mpcsa_usart_stop_tx(struct at91usart_softc *sc);
     74 static void mpcsa_usart_rx_started(struct at91usart_softc *sc);
     75 static void mpcsa_usart_rx_stopped(struct at91usart_softc *sc);
     76 static void mpcsa_usart_rx_rts_ctl(struct at91usart_softc *sc, int enabled);
     77 
     78 static int mpcsa_gsm_cts_intr(void *);
     79 
     80 static __inline int
     81 led_num(struct mpcsa_usart_softc *mpsc)
     82 {
     83 	return (mpsc->sc_dev.sc_pid == PID_US3 ? LED_GSM : LED_SER1 + mpsc->sc_dev.sc_pid - PID_US0);
     84 }
     85 
     86 static __inline void
     87 comm_led(struct mpcsa_usart_softc *mpsc, int count)
     88 {
     89 	mpcsa_comm_led(led_num(mpsc), count);
     90 }
     91 
     92 static __inline void
     93 conn_led(struct mpcsa_usart_softc *mpsc, int count)
     94 {
     95 	mpcsa_conn_led(led_num(mpsc), count);
     96 }
     97 
     98 static int
     99 mpcsa_usart_match(struct device *parent, struct cfdata *match, void *aux)
    100 {
    101 	if (strcmp(match->cf_name, "at91usart") == 0 && strcmp(match->cf_atname, "mpcsa_usart") == 0)
    102 		return 2;
    103 	return 0;
    104 }
    105 
    106 
    107 static void
    108 mpcsa_usart_attach(struct device *parent, struct device *self, void *aux)
    109 {
    110 	struct mpcsa_usart_softc *sc = (struct mpcsa_usart_softc *)self;
    111 	struct at91bus_attach_args *sa = aux;
    112 
    113 	// initialize softc
    114 	if ((sc->sc_pioa = at91pio_sc(AT91_PIOA)) == NULL) {
    115 		printf("no PIOA!\n");
    116 		return;
    117 	}
    118 	if ((sc->sc_piob = at91pio_sc(AT91_PIOB)) == NULL) {
    119 		printf("no PIOB!\n");
    120 		return;
    121 	}
    122 	if ((sc->sc_piod = at91pio_sc(AT91_PIOD)) == NULL) {
    123 		printf("no PIOD!\n");
    124 		return;
    125 	}
    126 
    127 	// calculate unit number...
    128 	switch (sa->sa_pid) {
    129 	case PID_US0:
    130 	case PID_US1:
    131 	case PID_US2:
    132 	case PID_US3:
    133 		sc->sc_dev.enable = mpcsa_usart_enable;
    134 		sc->sc_dev.disable = mpcsa_usart_disable;
    135 		sc->sc_dev.hwflow = mpcsa_usart_hwflow;
    136 		sc->sc_dev.start_tx = mpcsa_usart_start_tx;
    137 		sc->sc_dev.stop_tx = mpcsa_usart_stop_tx;
    138 		sc->sc_dev.rx_started = mpcsa_usart_rx_started;
    139 		sc->sc_dev.rx_stopped = mpcsa_usart_rx_stopped;
    140 		sc->sc_dev.rx_rts_ctl = mpcsa_usart_rx_rts_ctl;
    141 		break;
    142 	}
    143 
    144 	/* configure pins */
    145 	switch (sa->sa_pid) {
    146 	case PID_US0:
    147 		at91pio_set(sc->sc_piob, PB_RTS1);
    148 		at91pio_set(sc->sc_piod, PD_DTR1);
    149 		at91pio_in(sc->sc_piob, PB_CTS1);
    150 		at91pio_out(sc->sc_piob, PB_RTS1);
    151 		at91pio_in(sc->sc_piod, PD_DSR1);
    152 		at91pio_out(sc->sc_piod, PD_DTR1);
    153 		at91pio_per(sc->sc_piob, PB_CTS1, -1);
    154 		at91pio_per(sc->sc_piob, PB_RTS1, -1);
    155 		at91pio_per(sc->sc_piod, PD_DSR1, -1);
    156 		at91pio_per(sc->sc_piod, PD_DTR1, -1);
    157 		break;
    158 	case PID_US1:
    159 		at91pio_set(sc->sc_piob, PB_RTS2);
    160 		at91pio_set(sc->sc_piod, PD_DTR2);
    161 		at91pio_in(sc->sc_piob, PB_CTS2);
    162 		at91pio_out(sc->sc_piob, PB_RTS2);
    163 		at91pio_in(sc->sc_piod, PD_DSR2);
    164 		at91pio_out(sc->sc_piod, PD_DTR2);
    165 		at91pio_per(sc->sc_piob, PB_CTS2, -1);
    166 		at91pio_per(sc->sc_piob, PB_RTS2, -1);
    167 		at91pio_per(sc->sc_piod, PD_DSR2, -1);
    168 		at91pio_per(sc->sc_piod, PD_DTR2, -1);
    169 		break;
    170 	case PID_US2:
    171 		at91pio_set(sc->sc_piob, PB_RTS3);
    172 		at91pio_set(sc->sc_piod, PD_DTR3);
    173 		at91pio_in(sc->sc_piob, PB_CTS3);
    174 		at91pio_out(sc->sc_piob, PB_RTS3);
    175 		at91pio_in(sc->sc_piod, PD_DSR3);
    176 		at91pio_out(sc->sc_piod, PD_DTR3);
    177 		at91pio_per(sc->sc_piob, PB_CTS3, -1);
    178 		at91pio_per(sc->sc_piob, PB_RTS3, -1);
    179 		at91pio_per(sc->sc_piod, PD_DSR3, -1);
    180 		at91pio_per(sc->sc_piod, PD_DTR3, -1);
    181 		break;
    182 	case PID_US3:
    183 		/* configure pin states... */
    184 		at91pio_clear(sc->sc_pioa, PA_GSMON);
    185 		at91pio_set(sc->sc_pioa, PA_GSMOFF);
    186 		at91pio_set(sc->sc_piob, PB_RTS4);
    187 		at91pio_set(sc->sc_piod, PD_DTR4);
    188 
    189 		/* configure pin directions.. */
    190 		at91pio_out(sc->sc_pioa, PA_GSMOFF);
    191 		at91pio_out(sc->sc_pioa, PA_GSMON);
    192 		at91pio_in(sc->sc_pioa, PA_TXD4);
    193 		at91pio_in(sc->sc_piob, PB_RTS4);
    194 		at91pio_in(sc->sc_piob, PB_CTS4);
    195 		at91pio_in(sc->sc_piod, PD_DTR4);
    196 		at91pio_in(sc->sc_piod, PD_DSR4);
    197 		at91pio_in(sc->sc_piod, PD_DCD4);
    198 
    199 		/* make sure all related pins are configured as PIO */
    200 		at91pio_per(sc->sc_pioa, PA_GSMOFF, -1);
    201 		at91pio_per(sc->sc_pioa, PA_GSMON, -1);
    202 		at91pio_per(sc->sc_pioa, PA_TXD4, -1);
    203 		at91pio_per(sc->sc_piob, PB_CTS4, -1);
    204 		at91pio_per(sc->sc_piob, PB_RTS4, -1);
    205 		at91pio_per(sc->sc_piod, PD_DSR4, -1);
    206 		at91pio_per(sc->sc_piod, PD_DTR4, -1);
    207 		at91pio_per(sc->sc_piod, PD_DCD4, -1);
    208 		break;
    209 	}
    210 
    211 	// and call common routine
    212 	at91usart_attach_subr(&sc->sc_dev, sa);
    213 }
    214 
    215 static int
    216 mpcsa_usart_enable(struct at91usart_softc *dev)
    217 {
    218 	struct mpcsa_usart_softc *sc = (struct mpcsa_usart_softc *)dev;
    219 	conn_led(sc, 1);
    220 	switch (sc->sc_dev.sc_pid) {
    221 	case PID_US3:
    222 		/* turn gsm on */
    223 		at91pio_clear(sc->sc_pioa, PA_GSMOFF);
    224 		kpause("gsmond", false, 4 * hz, NULL);
    225 		at91pio_set(sc->sc_pioa, PA_GSMON);
    226 		kpause("gsmon", false, 2 * hz, NULL);
    227 		at91pio_clear(sc->sc_pioa, PA_GSMON);
    228 		/* then attach pins to devices etc */
    229 		at91pio_per(sc->sc_pioa, PA_TXD4, 1);
    230 		at91pio_clear(sc->sc_piob, PB_RTS4);
    231 		at91pio_clear(sc->sc_piod, PD_DTR4);
    232 		at91pio_out(sc->sc_piob, PB_RTS4);
    233 		at91pio_out(sc->sc_piod, PD_DTR4);
    234 		/* catch CTS interrupt */
    235 		sc->sc_cts_ih = at91pio_intr_establish(sc->sc_piob, PB_CTS4,
    236 						       IPL_TTY, mpcsa_gsm_cts_intr,
    237 						       sc);
    238 		break;
    239 	}
    240 	return 0;
    241 }
    242 
    243 static int
    244 mpcsa_usart_disable(struct at91usart_softc *dev)
    245 {
    246 	struct mpcsa_usart_softc *sc = (struct mpcsa_usart_softc *)dev;
    247 	if (sc->sc_tx_busy || sc->sc_rx_busy) {
    248 		sc->sc_tx_busy = sc->sc_rx_busy = 0;
    249 		comm_led(sc, 1);
    250 	}
    251 	switch (sc->sc_dev.sc_pid) {
    252 	case PID_US3:
    253 		at91pio_intr_disestablish(sc->sc_piob, PB_CTS4, sc->sc_cts_ih);
    254 
    255 		at91pio_clear(sc->sc_pioa, PA_GSMON);
    256 		kpause("gsmoffd", false, (hz * 350 + 999) / 1000, NULL);
    257 
    258 		at91pio_per(sc->sc_pioa, PA_TXD4, -1);
    259 		at91pio_in(sc->sc_piob, PB_RTS4);
    260 		at91pio_in(sc->sc_piod, PD_DTR4);
    261 
    262 		at91pio_set(sc->sc_pioa, PA_GSMOFF);
    263 		kpause("gsmoff", false, hz * 4, NULL);
    264 		at91pio_clear(sc->sc_pioa, PA_GSMOFF);
    265 
    266 		break;
    267 	}
    268 	conn_led(sc, 0);
    269 	return 0;
    270 }
    271 
    272 static int mpcsa_gsm_cts_intr(void *cookie)
    273 {
    274 	struct mpcsa_usart_softc *sc = (struct mpcsa_usart_softc *)cookie;
    275 	if (ISSET(sc->sc_dev.sc_swflags, TIOCFLAG_CRTSCTS)) {
    276 		/* hardware flow control is enabled */
    277 		if (!(PIOB_READ(PIO_PDSR) & (1U << PB_CTS4))) {
    278 			if (bus_space_read_4(sc->sc_dev.sc_iot, sc->sc_dev.sc_ioh,
    279 					     US_PDC + PDC_TCR) && !sc->sc_tx_busy) {
    280 				sc->sc_tx_busy = 1;
    281 				if (!sc->sc_rx_busy)
    282 					comm_led(sc, INFINITE_BLINK);
    283 			}
    284 
    285 			bus_space_write_4(sc->sc_dev.sc_iot, sc->sc_dev.sc_ioh,
    286 					  US_PDC + PDC_PTCR, PDC_PTCR_TXTEN);
    287 			SET(sc->sc_dev.sc_ier, US_CSR_TXEMPTY | US_CSR_ENDTX);
    288 			bus_space_write_4(sc->sc_dev.sc_iot, sc->sc_dev.sc_ioh,
    289 					  US_IER, US_CSR_ENDTX);
    290 		} else {
    291 			bus_space_write_4(sc->sc_dev.sc_iot, sc->sc_dev.sc_ioh,
    292 					  US_PDC + PDC_PTCR, PDC_PTCR_TXTDIS);
    293 			if (sc->sc_tx_busy) {
    294 				sc->sc_tx_busy = 0;
    295 				if (!sc->sc_rx_busy)
    296 					comm_led(sc, 1);
    297 			}
    298 		}
    299 	}
    300 	return 0;
    301 }
    302 
    303 static void
    304 mpcsa_usart_hwflow(struct at91usart_softc *dev, int flags)
    305 {
    306 }
    307 
    308 static void
    309 mpcsa_usart_start_tx(struct at91usart_softc *sc)
    310 {
    311 	if (!ISSET(sc->sc_swflags, TIOCFLAG_CRTSCTS)
    312 	    || bus_space_read_4(sc->sc_iot, sc->sc_ioh, US_PDC + PDC_PTSR) & PDC_PTSR_TXTEN) {
    313 		bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    314 				  US_PDC + PDC_PTCR, PDC_PTCR_TXTEN);
    315 		struct mpcsa_usart_softc *mpsc = (void*)sc;
    316 		if (!mpsc->sc_tx_busy) {
    317 			mpsc->sc_tx_busy = 1;
    318 			if (!mpsc->sc_rx_busy)
    319 				comm_led(mpsc, INFINITE_BLINK);
    320 		}
    321 		return;
    322 	}
    323 }
    324 
    325 static void
    326 mpcsa_usart_stop_tx(struct at91usart_softc *sc)
    327 {
    328 	struct mpcsa_usart_softc *mpsc = (void*)sc;
    329 	mpsc->sc_tx_busy = 0;
    330 	if (!mpsc->sc_rx_busy)
    331 		comm_led(mpsc, 1);
    332 	if (!ISSET(sc->sc_swflags, TIOCFLAG_CRTSCTS)) {
    333 		bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    334 				  US_PDC + PDC_PTCR, PDC_PTCR_TXTDIS);
    335 	}
    336 }
    337 
    338 static void
    339 mpcsa_usart_rx_started(struct at91usart_softc *sc)
    340 {
    341 	struct mpcsa_usart_softc *mpsc = (void*)sc;
    342 	if (!mpsc->sc_rx_busy) {
    343 		mpsc->sc_rx_busy = 1;
    344 		if (!mpsc->sc_tx_busy)
    345 			comm_led(mpsc, INFINITE_BLINK);
    346 	}
    347 }
    348 
    349 static void
    350 mpcsa_usart_rx_stopped(struct at91usart_softc *sc)
    351 {
    352 	struct mpcsa_usart_softc *mpsc = (void*)sc;
    353 	mpsc->sc_rx_busy = 0;
    354 	if (!mpsc->sc_tx_busy)
    355 		comm_led(mpsc, 1);
    356 }
    357 
    358 static void
    359 mpcsa_usart_rx_rts_ctl(struct at91usart_softc *sc, int enabled)
    360 {
    361 	struct mpcsa_usart_softc *mpsc = (void*)sc;
    362 
    363 	switch (mpsc->sc_dev.sc_pid) {
    364 	case PID_US0:
    365 		if (enabled)
    366 			at91pio_set(mpsc->sc_piob, PB_RTS1);
    367 		else
    368 			at91pio_clear(mpsc->sc_piob, PB_RTS1);
    369 		break;
    370 
    371 	case PID_US1:
    372 		if (enabled)
    373 			at91pio_set(mpsc->sc_piob, PB_RTS2);
    374 		else
    375 			at91pio_clear(mpsc->sc_piob, PB_RTS2);
    376 		break;
    377 
    378 	case PID_US2:
    379 		if (enabled)
    380 			at91pio_set(mpsc->sc_piob, PB_RTS3);
    381 		else
    382 			at91pio_clear(mpsc->sc_piob, PB_RTS3);
    383 		break;
    384 
    385 	case PID_US3:
    386 		if (enabled)
    387 			at91pio_set(mpsc->sc_piob, PB_RTS4);
    388 		else
    389 			at91pio_clear(mpsc->sc_piob, PB_RTS4);
    390 		break;
    391 
    392 	}
    393 
    394 }
    395 
    396