e9804c206ee1c306f21ac68552f51fbd329bcf93
[bertos.git] / cpu / arm / drv / ser_at91.c
1 /**
2  * \file
3  * <!--
4  * This file is part of BeRTOS.
5  *
6  * Bertos is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  * As a special exception, you may use this file as part of a free software
21  * library without restriction.  Specifically, if other files instantiate
22  * templates or use macros or inline functions from this file, or you compile
23  * this file and link it with other files to produce an executable, this
24  * file does not by itself cause the resulting executable to be covered by
25  * the GNU General Public License.  This exception does not however
26  * invalidate any other reasons why the executable file might be covered by
27  * the GNU General Public License.
28  *
29  * Copyright 2003, 2004 Develer S.r.l. (http://www.develer.com/)
30  * Copyright 2000 Bernardo Innocenti <bernie@codewiz.org>
31  *
32  * -->
33  *
34  * \brief ARM UART and SPI I/O driver
35  *
36  *
37  * \version $Id: ser_amr.c 18280 2007-10-11 15:14:20Z asterix $
38  * \author Daniele Basile <asterix@develer.com>
39  */
40
41 #include <io/arm.h>
42
43 #include <cpu/attr.h>
44 #include <drv/ser.h>
45 #include <drv/ser_p.h>
46
47 #include <hw/hw_ser.h>  /* Required for bus macros overrides */
48 #include <hw/hw_cpu.h>  /* CLOCK_FREQ */
49
50 #include <mware/fifobuf.h>
51 #include <cfg/debug.h>
52
53 #include <appconfig.h>
54
55 #define SERIRQ_PRIORITY 4 ///< default priority for serial irqs.
56
57 /**
58  * \name Overridable serial bus hooks
59  *
60  * These can be redefined in hw.h to implement
61  * special bus policies such as half-duplex, 485, etc.
62  *
63  *
64  * \code
65  *  TXBEGIN      TXCHAR      TXEND  TXOFF
66  *    |   __________|__________ |     |
67  *    |   |   |   |   |   |   | |     |
68  *    v   v   v   v   v   v   v v     v
69  * ______  __  __  __  __  __  __  ________________
70  *       \/  \/  \/  \/  \/  \/  \/
71  * ______/\__/\__/\__/\__/\__/\__/
72  *
73  * \endcode
74  *
75  * \{
76  */
77
78 #ifndef SER_UART0_IRQ_INIT
79         /**
80          * Default IRQ INIT macro - invoked in uart0_init()
81          *
82          * - Disable all interrupt
83          * - Register USART0 interrupt
84          * - Enable USART0 clock.
85          */
86         #define SER_UART0_IRQ_INIT do { \
87                 US0_IDR = 0xFFFFFFFF; \
88                 /* Set the vector. */ \
89                 AIC_SVR(US0_ID) = uart0_irq_dispatcher; \
90                 /* Initialize to edge triggered with defined priority. */ \
91                 AIC_SMR(US0_ID) = AIC_SRCTYPE_INT_EDGE_TRIGGERED | SERIRQ_PRIORITY; \
92                 /* Enable the USART IRQ */ \
93                 AIC_IECR = BV(US0_ID); \
94                 PMC_PCER = BV(US0_ID); \
95         } while (0)
96 #endif
97
98 #ifndef SER_UART0_BUS_TXINIT
99         /**
100          * Default TXINIT macro - invoked in uart0_init()
101          *
102          * - Disable GPIO on USART0 tx/rx pins
103          * - Reset USART0
104          * - Set serial param: mode Normal, 8bit data, 1bit stop
105          * - Enable both the receiver and the transmitter
106          * - Enable only the RX complete interrupt
107          */
108         #if !CPU_ARM_AT91SAM7S256
109                 #warning Check USART0 pins!
110         #endif
111         #define SER_UART0_BUS_TXINIT do { \
112                 PIOA_PDR = BV(RXD0) | BV(TXD0); \
113                 US0_CR = BV(US_RSTRX) | BV(US_RSTTX); \
114                 US0_MR = US_CHMODE_NORMAL | US_CHRL_8 | US_NBSTOP_1; \
115                 US0_CR = BV(US_RXEN) | BV(US_TXEN); \
116                 US0_IER = BV(US_RXRDY); \
117         } while (0)
118
119 #endif
120
121 #ifndef SER_UART0_BUS_TXBEGIN
122         /**
123          * Invoked before starting a transmission
124          *
125          * - Enable both the receiver and the transmitter
126          * - Enable both the RX complete and TX empty interrupts
127          */
128         #define SER_UART0_BUS_TXBEGIN do { \
129                 US0_CR = BV(US_RXEN) | BV(US_TXEN); \
130                 US0_IER = BV(US_TXRDY) | BV(US_RXRDY); \
131         } while (0)
132 #endif
133
134 #ifndef SER_UART0_BUS_TXCHAR
135         /**
136          * Invoked to send one character.
137          */
138         #define SER_UART0_BUS_TXCHAR(c) do { \
139                 US0_THR = (c); \
140         } while (0)
141 #endif
142
143 #ifndef SER_UART0_BUS_TXEND
144         /**
145          * Invoked as soon as the txfifo becomes empty
146          *
147          * - Keep both the receiver and the transmitter enabled
148          * - Keep the RX complete interrupt enabled
149          * - Disable the TX empty interrupts
150          */
151         #define SER_UART0_BUS_TXEND do { \
152                 US0_CR = BV(US_RXEN) | BV(US_TXEN); \
153                 US0_IER = BV(US_RXRDY); \
154                 US0_IDR = BV(US_TXRDY); \
155         } while (0)
156 #endif
157
158 /* End USART0 macros */
159
160 #ifndef SER_UART1_IRQ_INIT
161         /** \sa SER_UART0_BUS_TXINIT */
162         #define SER_UART1_IRQ_INIT do { \
163                 US1_IDR = 0xFFFFFFFF; \
164                 /* Set the vector. */ \
165                 AIC_SVR(US1_ID) = uart1_irq_dispatcher; \
166                 /* Initialize to edge triggered with defined priority. */ \
167                 AIC_SMR(US1_ID) = AIC_SRCTYPE_INT_EDGE_TRIGGERED | SERIRQ_PRIORITY; \
168                 /* Enable the USART IRQ */ \
169                 AIC_IECR = BV(US1_ID); \
170                 PMC_PCER = BV(US1_ID); \
171         } while (0)
172 #endif
173
174 #ifndef SER_UART1_BUS_TXINIT
175         /** \sa SER_UART1_BUS_TXINIT */
176         #if !CPU_ARM_AT91SAM7S256
177                 #warning Check USART1 pins!
178         #endif
179         #define SER_UART1_BUS_TXINIT do { \
180                 PIOA_PDR = BV(RXD1) | BV(TXD1); \
181                 US1_CR = BV(US_RSTRX) | BV(US_RSTTX); \
182                 US1_MR = US_CHMODE_NORMAL | US_CHRL_8 | US_NBSTOP_1; \
183                 US1_CR = BV(US_RXEN) | BV(US_TXEN); \
184                 US1_IER = BV(US_RXRDY); \
185         } while (0)
186 #endif
187
188 #ifndef SER_UART1_BUS_TXBEGIN
189         /** \sa SER_UART1_BUS_TXBEGIN */
190         #define SER_UART1_BUS_TXBEGIN do { \
191                 US1_CR = BV(US_RXEN) | BV(US_TXEN); \
192                 US1_IER = BV(US_TXRDY) | BV(US_RXRDY); \
193         } while (0)
194 #endif
195
196 #ifndef SER_UART1_BUS_TXCHAR
197         /** \sa SER_UART1_BUS_TXCHAR */
198         #define SER_UART1_BUS_TXCHAR(c) do { \
199                 US1_THR = (c); \
200         } while (0)
201 #endif
202
203 #ifndef SER_UART1_BUS_TXEND
204         /** \sa SER_UART1_BUS_TXEND */
205         #define SER_UART1_BUS_TXEND do { \
206                 US1_CR = BV(US_RXEN) | BV(US_TXEN); \
207                 US1_IER = BV(US_RXRDY); \
208                 US1_IDR = BV(US_TXRDY); \
209         } while (0)
210 #endif
211
212 /**
213  * \name Overridable SPI hooks
214  *
215  * These can be redefined in hw.h to implement
216  * special bus policies such as slave select pin handling, etc.
217  *
218  * \{
219  */
220 #ifndef SER_SPI_BUS_TXINIT
221         /**
222          * Default TXINIT macro - invoked in spi_init()
223          * The default is no action.
224          */
225         #define SER_SPI_BUS_TXINIT
226 #endif
227
228 #ifndef SER_SPI_BUS_TXCLOSE
229         /**
230          * Invoked after the last character has been transmitted.
231          * The default is no action.
232          */
233         #define SER_SPI_BUS_TXCLOSE
234 #endif
235 /*\}*/
236
237
238 /**
239  * \def CONFIG_SER_STROBE
240  *
241  * This is a debug facility that can be used to
242  * monitor SER interrupt activity on an external pin.
243  *
244  * To use strobes, redefine the macros SER_STROBE_ON,
245  * SER_STROBE_OFF and SER_STROBE_INIT and set
246  * CONFIG_SER_STROBE to 1.
247  */
248 #if !defined(CONFIG_SER_STROBE) || !CONFIG_SER_STROBE
249         #define SER_STROBE_ON    do {/*nop*/} while(0)
250         #define SER_STROBE_OFF   do {/*nop*/} while(0)
251         #define SER_STROBE_INIT  do {/*nop*/} while(0)
252 #endif
253
254
255 /* From the high-level serial driver */
256 extern struct Serial ser_handles[SER_CNT];
257
258 /* TX and RX buffers */
259 static unsigned char uart0_txbuffer[CONFIG_UART0_TXBUFSIZE];
260 static unsigned char uart0_rxbuffer[CONFIG_UART0_RXBUFSIZE];
261
262 static unsigned char uart1_txbuffer[CONFIG_UART1_TXBUFSIZE];
263 static unsigned char uart1_rxbuffer[CONFIG_UART1_RXBUFSIZE];
264
265 static unsigned char spi_txbuffer[CONFIG_SPI_TXBUFSIZE];
266 static unsigned char spi_rxbuffer[CONFIG_SPI_RXBUFSIZE];
267
268 /**
269  * Internal hardware state structure
270  *
271  * The \a sending variable is true while the transmission
272  * interrupt is retriggering itself.
273  *
274  * For the USARTs the \a sending flag is useful for taking specific
275  * actions before sending a burst of data, at the start of a trasmission
276  * but not before every char sent.
277  *
278  * For the SPI, this flag is necessary because the SPI sends and receives
279  * bytes at the same time and the SPI IRQ is unique for send/receive.
280  * The only way to start transmission is to write data in SPDR (this
281  * is done by spi_starttx()). We do this *only* if a transfer is
282  * not already started.
283  */
284 struct ArmSerial
285 {
286         struct SerialHardware hw;
287         volatile bool sending;
288 };
289
290
291 /*
292  * These are to trick GCC into *not* using absolute addressing mode
293  * when accessing ser_handles, which is very expensive.
294  *
295  * Accessing through these pointers generates much shorter
296  * (and hopefully faster) code.
297  */
298 struct Serial *ser_uart0 = &ser_handles[SER_UART0];
299 struct Serial *ser_uart1 = &ser_handles[SER_UART1];
300 struct Serial *ser_spi = &ser_handles[SER_SPI];
301
302 static void uart0_irq_dispatcher(void);
303 static void uart1_irq_dispatcher(void);
304 /*
305  * Callbacks for USART0
306  */
307 static void uart0_init(
308         UNUSED_ARG(struct SerialHardware *, _hw),
309         UNUSED_ARG(struct Serial *, ser))
310 {
311         SER_UART0_IRQ_INIT;
312         SER_UART0_BUS_TXINIT;
313         SER_STROBE_INIT;
314 }
315
316 static void uart0_cleanup(UNUSED_ARG(struct SerialHardware *, _hw))
317 {
318         US0_CR = BV(US_RSTRX) | BV(US_RSTTX) | BV(US_RXDIS) | BV(US_TXDIS) | BV(US_RSTSTA);
319 }
320
321 static void uart0_enabletxirq(struct SerialHardware *_hw)
322 {
323         struct ArmSerial *hw = (struct ArmSerial *)_hw;
324
325         /*
326          * WARNING: racy code here!  The tx interrupt sets hw->sending to false
327          * when it runs with an empty fifo.  The order of statements in the
328          * if-block matters.
329          */
330         if (!hw->sending)
331         {
332                 hw->sending = true;
333                 SER_UART0_BUS_TXBEGIN;
334         }
335 }
336
337 static void uart0_setbaudrate(UNUSED_ARG(struct SerialHardware *, _hw), unsigned long rate)
338 {
339         /* Compute baud-rate period */
340         US0_BRGR = CLOCK_FREQ / (16 * rate);
341         //DB(kprintf("uart0_setbaudrate(rate=%lu): period=%d\n", rate, period);)
342 }
343
344 static void uart0_setparity(UNUSED_ARG(struct SerialHardware *, _hw), int parity)
345 {
346         US0_MR &= ~US_PAR_MASK;
347         /* Set UART parity */
348         switch(parity)
349         {
350                 case SER_PARITY_NONE:
351                 {
352             /* Parity mode. */
353                         US0_MR |= US_PAR_NO;
354                         break;
355                 }
356                 case SER_PARITY_EVEN:
357                 {
358             /* Even parity.*/
359                         US0_MR |= US_PAR_EVEN;
360                         break;
361                 }
362                 case SER_PARITY_ODD:
363                 {
364             /* Odd parity.*/
365                         US0_MR |= US_PAR_ODD;
366                         break;
367                 }
368                 default:
369                         ASSERT(0);
370         }
371
372 }
373 /*
374  * Callbacks for USART1
375  */
376 static void uart1_init(
377         UNUSED_ARG(struct SerialHardware *, _hw),
378         UNUSED_ARG(struct Serial *, ser))
379 {
380         SER_UART1_IRQ_INIT;
381         SER_UART1_BUS_TXINIT;
382         SER_STROBE_INIT;
383 }
384
385 static void uart1_cleanup(UNUSED_ARG(struct SerialHardware *, _hw))
386 {
387         US1_CR = BV(US_RSTRX) | BV(US_RSTTX) | BV(US_RXDIS) | BV(US_TXDIS) | BV(US_RSTSTA);
388 }
389
390 static void uart1_enabletxirq(struct SerialHardware *_hw)
391 {
392         struct ArmSerial *hw = (struct ArmSerial *)_hw;
393
394         /*
395          * WARNING: racy code here!  The tx interrupt sets hw->sending to false
396          * when it runs with an empty fifo.  The order of statements in the
397          * if-block matters.
398          */
399         if (!hw->sending)
400         {
401                 hw->sending = true;
402                 SER_UART1_BUS_TXBEGIN;
403         }
404 }
405
406 static void uart1_setbaudrate(UNUSED_ARG(struct SerialHardware *, _hw), unsigned long rate)
407 {
408         /* Compute baud-rate period */
409         US1_BRGR = CLOCK_FREQ / (16 * rate);
410         //DB(kprintf("uart0_setbaudrate(rate=%lu): period=%d\n", rate, period);)
411 }
412
413 static void uart1_setparity(UNUSED_ARG(struct SerialHardware *, _hw), int parity)
414 {
415         US1_MR &= ~US_PAR_MASK;
416         /* Set UART parity */
417         switch(parity)
418         {
419                 case SER_PARITY_NONE:
420                 {
421             /* Parity mode. */
422                         US1_MR |= US_PAR_NO;
423                         break;
424                 }
425                 case SER_PARITY_EVEN:
426                 {
427             /* Even parity.*/
428                         US1_MR |= US_PAR_EVEN;
429                         break;
430                 }
431                 case SER_PARITY_ODD:
432                 {
433             /* Odd parity.*/
434                         US1_MR |= US_PAR_ODD;
435                         break;
436                 }
437                 default:
438                         ASSERT(0);
439         }
440
441 }
442
443 /* SPI driver */
444
445 static void spi_init(UNUSED_ARG(struct SerialHardware *, _hw), UNUSED_ARG(struct Serial *, ser))
446 {
447         /*
448          * Set MOSI and SCK ports out, MISO in.
449          *
450          * The ATmega64/128 datasheet explicitly states that the input/output
451          * state of the SPI pins is not significant, as when the SPI is
452          * active the I/O port are overrided.
453          * This is *blatantly FALSE*.
454          *
455          * Moreover, the MISO pin on the board_kc *must* be in high impedance
456          * state even when the SPI is off, because the line is wired together
457          * with the KBus serial RX, and the transmitter of the slave boards
458          * would be unable to drive the line.
459          */
460         ATOMIC(SPI_DDR |= (BV(SPI_MOSI_BIT) | BV(SPI_SCK_BIT)));
461
462         /*
463          * If the SPI master mode is activated and the SS pin is in input and tied low,
464          * the SPI hardware will automatically switch to slave mode!
465          * For proper communication this pins should therefore be:
466          * - as output
467          * - as input but tied high forever!
468          * This driver set the pin as output.
469          */
470         #warning SPI SS pin set as output for proper operation, check schematics for possible conflicts.
471         ATOMIC(SPI_DDR |= BV(SPI_SS_BIT));
472
473         ATOMIC(SPI_DDR &= ~BV(SPI_MISO_BIT));
474         /* Enable SPI, IRQ on, Master */
475         SPCR = BV(SPE) | BV(SPIE) | BV(MSTR);
476
477         /* Set data order */
478         #if CONFIG_SPI_DATA_ORDER == SER_LSB_FIRST
479                 SPCR |= BV(DORD);
480         #endif
481
482         /* Set SPI clock rate */
483         #if CONFIG_SPI_CLOCK_DIV == 128
484                 SPCR |= (BV(SPR1) | BV(SPR0));
485         #elif (CONFIG_SPI_CLOCK_DIV == 64 || CONFIG_SPI_CLOCK_DIV == 32)
486                 SPCR |= BV(SPR1);
487         #elif (CONFIG_SPI_CLOCK_DIV == 16 || CONFIG_SPI_CLOCK_DIV == 8)
488                 SPCR |= BV(SPR0);
489         #elif (CONFIG_SPI_CLOCK_DIV == 4 || CONFIG_SPI_CLOCK_DIV == 2)
490                 // SPR0 & SDPR1 both at 0
491         #else
492                 #error Unsupported SPI clock division factor.
493         #endif
494
495         /* Set SPI2X bit (spi double frequency) */
496         #if (CONFIG_SPI_CLOCK_DIV == 128 || CONFIG_SPI_CLOCK_DIV == 64 \
497           || CONFIG_SPI_CLOCK_DIV == 16 || CONFIG_SPI_CLOCK_DIV == 4)
498                 SPSR &= ~BV(SPI2X);
499         #elif (CONFIG_SPI_CLOCK_DIV == 32 || CONFIG_SPI_CLOCK_DIV == 8 || CONFIG_SPI_CLOCK_DIV == 2)
500                 SPSR |= BV(SPI2X);
501         #else
502                 #error Unsupported SPI clock division factor.
503         #endif
504
505         /* Set clock polarity */
506         #if CONFIG_SPI_CLOCK_POL == 1
507                 SPCR |= BV(CPOL);
508         #endif
509
510         /* Set clock phase */
511         #if CONFIG_SPI_CLOCK_PHASE == 1
512                 SPCR |= BV(CPHA);
513         #endif
514         SER_SPI_BUS_TXINIT;
515
516         SER_STROBE_INIT;
517 }
518
519 static void spi_cleanup(UNUSED_ARG(struct SerialHardware *, _hw))
520 {
521         SPCR = 0;
522
523         SER_SPI_BUS_TXCLOSE;
524
525         /* Set all pins as inputs */
526         ATOMIC(SPI_DDR &= ~(BV(SPI_MISO_BIT) | BV(SPI_MOSI_BIT) | BV(SPI_SCK_BIT) | BV(SPI_SS_BIT)));
527 }
528
529 static void spi_starttx(struct SerialHardware *_hw)
530 {
531         struct AvrSerial *hw = (struct AvrSerial *)_hw;
532
533         cpuflags_t flags;
534         IRQ_SAVE_DISABLE(flags);
535
536         /* Send data only if the SPI is not already transmitting */
537         if (!hw->sending && !fifo_isempty(&ser_spi->txfifo))
538         {
539                 hw->sending = true;
540                 SPDR = fifo_pop(&ser_spi->txfifo);
541         }
542
543         IRQ_RESTORE(flags);
544 }
545
546 static void spi_setbaudrate(
547         UNUSED_ARG(struct SerialHardware *, _hw),
548         UNUSED_ARG(unsigned long, rate))
549 {
550         // nop
551 }
552
553 static void spi_setparity(UNUSED_ARG(struct SerialHardware *, _hw), UNUSED_ARG(int, parity))
554 {
555         // nop
556 }
557
558
559
560 static bool tx_sending(struct SerialHardware* _hw)
561 {
562         struct ArmSerial *hw = (struct ArmSerial *)_hw;
563         return hw->sending;
564 }
565
566 // FIXME: move into compiler.h?  Ditch?
567 #if COMPILER_C99
568         #define C99INIT(name,val) .name = val
569 #elif defined(__GNUC__)
570         #define C99INIT(name,val) name: val
571 #else
572         #warning No designated initializers, double check your code
573         #define C99INIT(name,val) (val)
574 #endif
575
576 /*
577  * High-level interface data structures
578  */
579 static const struct SerialHardwareVT UART0_VT =
580 {
581         C99INIT(init, uart0_init),
582         C99INIT(cleanup, uart0_cleanup),
583         C99INIT(setBaudrate, uart0_setbaudrate),
584         C99INIT(setParity, uart0_setparity),
585         C99INIT(txStart, uart0_enabletxirq),
586         C99INIT(txSending, tx_sending),
587 };
588
589 static const struct SerialHardwareVT UART1_VT =
590 {
591         C99INIT(init, uart1_init),
592         C99INIT(cleanup, uart1_cleanup),
593         C99INIT(setBaudrate, uart1_setbaudrate),
594         C99INIT(setParity, uart1_setparity),
595         C99INIT(txStart, uart1_enabletxirq),
596         C99INIT(txSending, tx_sending),
597 };
598
599 static const struct SerialHardwareVT SPI_VT =
600 {
601         C99INIT(init, spi_init),
602         C99INIT(cleanup, spi_cleanup),
603         C99INIT(setBaudrate, spi_setbaudrate),
604         C99INIT(setParity, spi_setparity),
605         C99INIT(txStart, spi_starttx),
606         C99INIT(txSending, tx_sending),
607 };
608
609 static struct ArmSerial UARTDescs[SER_CNT] =
610 {
611         {
612                 C99INIT(hw, /**/) {
613                         C99INIT(table, &UART0_VT),
614                         C99INIT(txbuffer, uart0_txbuffer),
615                         C99INIT(rxbuffer, uart0_rxbuffer),
616                         C99INIT(txbuffer_size, sizeof(uart0_txbuffer)),
617                         C99INIT(rxbuffer_size, sizeof(uart0_rxbuffer)),
618                 },
619                 C99INIT(sending, false),
620         },
621         {
622                 C99INIT(hw, /**/) {
623                         C99INIT(table, &UART1_VT),
624                         C99INIT(txbuffer, uart1_txbuffer),
625                         C99INIT(rxbuffer, uart1_rxbuffer),
626                         C99INIT(txbuffer_size, sizeof(uart1_txbuffer)),
627                         C99INIT(rxbuffer_size, sizeof(uart1_rxbuffer)),
628                 },
629                 C99INIT(sending, false),
630         },
631         {
632                 C99INIT(hw, /**/) {
633                         C99INIT(table, &SPI_VT),
634                         C99INIT(txbuffer, spi_txbuffer),
635                         C99INIT(rxbuffer, spi_rxbuffer),
636                         C99INIT(txbuffer_size, sizeof(spi_txbuffer)),
637                         C99INIT(rxbuffer_size, sizeof(spi_rxbuffer)),
638                 },
639                 C99INIT(sending, false),
640         }
641 };
642
643 struct SerialHardware *ser_hw_getdesc(int unit)
644 {
645         ASSERT(unit < SER_CNT);
646         return &UARTDescs[unit].hw;
647 }
648
649 /**
650  * Serial 0 TX interrupt handler
651  */
652 static void uart0_irq_tx(void)
653 {
654         SER_STROBE_ON;
655
656         struct FIFOBuffer * const txfifo = &ser_uart0->txfifo;
657
658         if (fifo_isempty(txfifo))
659         {
660                 SER_UART0_BUS_TXEND;
661                 UARTDescs[SER_UART0].sending = false;
662         }
663         else
664         {
665                 char c = fifo_pop(txfifo);
666                 SER_UART0_BUS_TXCHAR(c);
667         }
668
669         SER_STROBE_OFF;
670 }
671
672 /**
673  * Serial 0 RX complete interrupt handler.
674  */
675 static void uart0_irq_rx(void)
676 {
677         SER_STROBE_ON;
678
679         /* Should be read before US_CRS */
680         ser_uart0->status |= US0_CSR & (SERRF_RXSROVERRUN | SERRF_FRAMEERROR);
681
682         char c = US0_RHR;
683         struct FIFOBuffer * const rxfifo = &ser_uart0->rxfifo;
684
685         if (fifo_isfull(rxfifo))
686                 ser_uart0->status |= SERRF_RXFIFOOVERRUN;
687         else
688                 fifo_push(rxfifo, c);
689
690         SER_STROBE_OFF;
691 }
692
693 /**
694  * Serial IRQ dispatcher for USART0.
695  */
696 static void uart0_irq_dispatcher(void) __attribute__ ((naked));
697 static void uart0_irq_dispatcher(void)
698 {
699         IRQ_ENTRY();
700
701         if (US0_IMR & BV(US_RXRDY))
702                 uart0_irq_rx();
703
704         if (US0_IMR & BV(US_TXRDY))
705                 uart0_irq_tx();
706
707         IRQ_EXIT();
708 }
709
710 /**
711  * Serial 1 TX interrupt handler
712  */
713 static void uart1_irq_tx(void)
714 {
715         SER_STROBE_ON;
716
717         struct FIFOBuffer * const txfifo = &ser_uart1->txfifo;
718
719         if (fifo_isempty(txfifo))
720         {
721                 SER_UART1_BUS_TXEND;
722                 UARTDescs[SER_UART1].sending = false;
723         }
724         else
725         {
726                 char c = fifo_pop(txfifo);
727                 SER_UART1_BUS_TXCHAR(c);
728         }
729
730         SER_STROBE_OFF;
731 }
732
733 /**
734  * Serial 1 RX complete interrupt handler.
735  */
736 static void uart1_irq_rx(void)
737 {
738         SER_STROBE_ON;
739
740         /* Should be read before US_CRS */
741         ser_uart1->status |= US1_CSR & (SERRF_RXSROVERRUN | SERRF_FRAMEERROR);
742
743         char c = US1_RHR;
744         struct FIFOBuffer * const rxfifo = &ser_uart1->rxfifo;
745
746         if (fifo_isfull(rxfifo))
747                 ser_uart1->status |= SERRF_RXFIFOOVERRUN;
748         else
749                 fifo_push(rxfifo, c);
750
751         SER_STROBE_OFF;
752 }
753
754 /**
755  * Serial IRQ dispatcher for USART1.
756  */
757 static void uart1_irq_dispatcher(void) __attribute__ ((naked));
758 static void uart1_irq_dispatcher(void)
759 {
760         IRQ_ENTRY();
761
762         if (US1_IMR & BV(US_RXRDY))
763                 uart1_irq_rx();
764
765         if (US1_IMR & BV(US_TXRDY))
766                 uart1_irq_tx();
767
768         IRQ_EXIT();
769 }