|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623 |
- /* Teensyduino Core Library
- * http://www.pjrc.com/teensy/
- * Copyright (c) 2013 PJRC.COM, LLC.
- *
- * Permission is hereby granted, free of charge, to any person obtaining
- * a copy of this software and associated documentation files (the
- * "Software"), to deal in the Software without restriction, including
- * without limitation the rights to use, copy, modify, merge, publish,
- * distribute, sublicense, and/or sell copies of the Software, and to
- * permit persons to whom the Software is furnished to do so, subject to
- * the following conditions:
- *
- * 1. The above copyright notice and this permission notice shall be
- * included in all copies or substantial portions of the Software.
- *
- * 2. If the Software is incorporated into a build system that allows
- * selection among a list of target devices, then similar target
- * devices manufactured by PJRC.COM must be included in the list of
- * target devices and selectable in the same manner.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
- * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
- * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
- * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
- * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
- * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
- * SOFTWARE.
- */
-
- #include "kinetis.h"
- #include "core_pins.h"
- #include "HardwareSerial.h"
-
- ////////////////////////////////////////////////////////////////
- // Tunable parameters (relatively safe to edit these numbers)
- ////////////////////////////////////////////////////////////////
-
- #define TX_BUFFER_SIZE 64 // number of outgoing bytes to buffer
- #define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
- #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
- #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
- #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
-
-
- ////////////////////////////////////////////////////////////////
- // changes not recommended below this point....
- ////////////////////////////////////////////////////////////////
-
- #ifdef SERIAL_9BIT_SUPPORT
- static uint8_t use9Bits = 0;
- #define BUFTYPE uint16_t
- #else
- #define BUFTYPE uint8_t
- #define use9Bits 0
- #endif
-
- static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
- static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
- static volatile uint8_t transmitting = 0;
- #if defined(KINETISK)
- static volatile uint8_t *transmit_pin=NULL;
- #define transmit_assert() *transmit_pin = 1
- #define transmit_deassert() *transmit_pin = 0
- static volatile uint8_t *rts_pin=NULL;
- #define rts_assert() *rts_pin = 0
- #define rts_deassert() *rts_pin = 1
- #elif defined(KINETISL)
- static volatile uint8_t *transmit_pin=NULL;
- static uint8_t transmit_mask=0;
- #define transmit_assert() *(transmit_pin+4) = transmit_mask;
- #define transmit_deassert() *(transmit_pin+8) = transmit_mask;
- static volatile uint8_t *rts_pin=NULL;
- static uint8_t rts_mask=0;
- #define rts_assert() *(rts_pin+8) = rts_mask;
- #define rts_deassert() *(rts_pin+4) = rts_mask;
- #endif
- #if TX_BUFFER_SIZE > 255
- static volatile uint16_t tx_buffer_head = 0;
- static volatile uint16_t tx_buffer_tail = 0;
- #else
- static volatile uint8_t tx_buffer_head = 0;
- static volatile uint8_t tx_buffer_tail = 0;
- #endif
- #if RX_BUFFER_SIZE > 255
- static volatile uint16_t rx_buffer_head = 0;
- static volatile uint16_t rx_buffer_tail = 0;
- #else
- static volatile uint8_t rx_buffer_head = 0;
- static volatile uint8_t rx_buffer_tail = 0;
- #endif
- static uint8_t rx_pin_num = 0;
- static uint8_t tx_pin_num = 1;
-
- // UART0 and UART1 are clocked by F_CPU, UART2 is clocked by F_BUS
- // UART0 has 8 byte fifo, UART1 and UART2 have 1 byte buffer
-
- #ifdef HAS_KINETISK_UART0_FIFO
- #define C2_ENABLE UART_C2_TE | UART_C2_RE | UART_C2_RIE | UART_C2_ILIE
- #else
- #define C2_ENABLE UART_C2_TE | UART_C2_RE | UART_C2_RIE
- #endif
- #define C2_TX_ACTIVE C2_ENABLE | UART_C2_TIE
- #define C2_TX_COMPLETING C2_ENABLE | UART_C2_TCIE
- #define C2_TX_INACTIVE C2_ENABLE
-
- void serial_begin(uint32_t divisor)
- {
- SIM_SCGC4 |= SIM_SCGC4_UART0; // turn on clock, TODO: use bitband
- rx_buffer_head = 0;
- rx_buffer_tail = 0;
- tx_buffer_head = 0;
- tx_buffer_tail = 0;
- transmitting = 0;
- switch (rx_pin_num) {
- case 0: CORE_PIN0_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- case 21: CORE_PIN21_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- #if defined(KINETISL)
- case 3: CORE_PIN3_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(2); break;
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 27: CORE_PIN27_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- #endif
- }
- switch (tx_pin_num) {
- case 1: CORE_PIN1_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
- case 5: CORE_PIN5_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
- #if defined(KINETISL)
- case 4: CORE_PIN4_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(2); break;
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 26: CORE_PIN26_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
- #endif
- }
- #if defined(HAS_KINETISK_UART0)
- UART0_BDH = (divisor >> 13) & 0x1F;
- UART0_BDL = (divisor >> 5) & 0xFF;
- UART0_C4 = divisor & 0x1F;
- #ifdef HAS_KINETISK_UART0_FIFO
- UART0_C1 = UART_C1_ILT;
- UART0_TWFIFO = 2; // tx watermark, causes S1_TDRE to set
- UART0_RWFIFO = 4; // rx watermark, causes S1_RDRF to set
- UART0_PFIFO = UART_PFIFO_TXFE | UART_PFIFO_RXFE;
- #else
- UART0_C1 = 0;
- UART0_PFIFO = 0;
- #endif
- #elif defined(HAS_KINETISL_UART0)
- UART0_BDH = (divisor >> 8) & 0x1F;
- UART0_BDL = divisor & 0xFF;
- UART0_C1 = 0;
- #endif
- UART0_C2 = C2_TX_INACTIVE;
- NVIC_SET_PRIORITY(IRQ_UART0_STATUS, IRQ_PRIORITY);
- NVIC_ENABLE_IRQ(IRQ_UART0_STATUS);
- }
-
- void serial_format(uint32_t format)
- {
- uint8_t c;
-
- c = UART0_C1;
- c = (c & ~0x13) | (format & 0x03); // configure parity
- if (format & 0x04) c |= 0x10; // 9 bits (might include parity)
- UART0_C1 = c;
- if ((format & 0x0F) == 0x04) UART0_C3 |= 0x40; // 8N2 is 9 bit with 9th bit always 1
- c = UART0_S2 & ~0x10;
- if (format & 0x10) c |= 0x10; // rx invert
- UART0_S2 = c;
- c = UART0_C3 & ~0x10;
- if (format & 0x20) c |= 0x10; // tx invert
- UART0_C3 = c;
- #ifdef SERIAL_9BIT_SUPPORT
- c = UART0_C4 & 0x1F;
- if (format & 0x08) c |= 0x20; // 9 bit mode with parity (requires 10 bits)
- UART0_C4 = c;
- use9Bits = format & 0x80;
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__) || defined(KINETISL)
- // For T3.5/T3.6/TLC See about turning on 2 stop bit mode
- if ( format & 0x100) {
- uint8_t bdl = UART0_BDL;
- UART0_BDH |= UART_BDH_SBNS; // Turn on 2 stop bits - was turned off by set baud
- UART0_BDL = bdl; // Says BDH not acted on until BDL is written
- }
- #endif
- }
-
- void serial_end(void)
- {
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
- while (transmitting) yield(); // wait for buffered data to send
- NVIC_DISABLE_IRQ(IRQ_UART0_STATUS);
- UART0_C2 = 0;
- CORE_PIN0_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1);
- CORE_PIN1_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1);
- rx_buffer_head = 0;
- rx_buffer_tail = 0;
- if (rts_pin) rts_deassert();
- }
-
- void serial_set_transmit_pin(uint8_t pin)
- {
- while (transmitting) ;
- pinMode(pin, OUTPUT);
- digitalWrite(pin, LOW);
- transmit_pin = portOutputRegister(pin);
- #if defined(KINETISL)
- transmit_mask = digitalPinToBitMask(pin);
- #endif
- }
-
- void serial_set_tx(uint8_t pin, uint8_t opendrain)
- {
- uint32_t cfg;
-
- if (opendrain) pin |= 128;
- if (pin == tx_pin_num) return;
- if ((SIM_SCGC4 & SIM_SCGC4_UART0)) {
- switch (tx_pin_num & 127) {
- case 1: CORE_PIN1_CONFIG = 0; break; // PTB17
- case 5: CORE_PIN5_CONFIG = 0; break; // PTD7
- #if defined(KINETISL)
- case 4: CORE_PIN4_CONFIG = 0; break; // PTA2
- case 24: CORE_PIN24_CONFIG = 0; break; // PTE20
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 26: CORE_PIN26_CONFIG = 0; break; //PTA14
- #endif
- }
- if (opendrain) {
- cfg = PORT_PCR_DSE | PORT_PCR_ODE;
- } else {
- cfg = PORT_PCR_DSE | PORT_PCR_SRE;
- }
- switch (pin & 127) {
- case 1: CORE_PIN1_CONFIG = cfg | PORT_PCR_MUX(3); break;
- case 5: CORE_PIN5_CONFIG = cfg | PORT_PCR_MUX(3); break;
- #if defined(KINETISL)
- case 4: CORE_PIN4_CONFIG = cfg | PORT_PCR_MUX(2); break;
- case 24: CORE_PIN24_CONFIG = cfg | PORT_PCR_MUX(4); break;
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 26: CORE_PIN26_CONFIG = cfg | PORT_PCR_MUX(3); break;
- #endif
- }
- }
- tx_pin_num = pin;
- }
-
- void serial_set_rx(uint8_t pin)
- {
- if (pin == rx_pin_num) return;
- if ((SIM_SCGC4 & SIM_SCGC4_UART0)) {
- switch (rx_pin_num) {
- case 0: CORE_PIN0_CONFIG = 0; break; // PTB16
- case 21: CORE_PIN21_CONFIG = 0; break; // PTD6
- #if defined(KINETISL)
- case 3: CORE_PIN3_CONFIG = 0; break; // PTA1
- case 25: CORE_PIN25_CONFIG = 0; break; // PTE21
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 27: CORE_PIN27_CONFIG = 0; break; // PTA15
- #endif
- }
- switch (pin) {
- case 0: CORE_PIN0_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- case 21: CORE_PIN21_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- #if defined(KINETISL)
- case 3: CORE_PIN3_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(2); break;
- case 25: CORE_PIN25_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(4); break;
- #endif
- #if defined(__MK64FX512__) || defined(__MK66FX1M0__)
- case 27: CORE_PIN27_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
- #endif
- }
- }
- rx_pin_num = pin;
- }
-
-
-
- int serial_set_rts(uint8_t pin)
- {
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return 0;
- if (pin < CORE_NUM_DIGITAL) {
- rts_pin = portOutputRegister(pin);
- #if defined(KINETISL)
- rts_mask = digitalPinToBitMask(pin);
- #endif
- pinMode(pin, OUTPUT);
- rts_assert();
- } else {
- rts_pin = NULL;
- return 0;
- }
- /*
- if (pin == 6) {
- CORE_PIN6_CONFIG = PORT_PCR_MUX(3);
- } else if (pin == 19) {
- CORE_PIN19_CONFIG = PORT_PCR_MUX(3);
- } else {
- UART0_MODEM &= ~UART_MODEM_RXRTSE;
- return 0;
- }
- UART0_MODEM |= UART_MODEM_RXRTSE;
- */
- return 1;
- }
-
- int serial_set_cts(uint8_t pin)
- {
- #if defined(KINETISK)
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return 0;
- if (pin == 18) {
- CORE_PIN18_CONFIG = PORT_PCR_MUX(3) | PORT_PCR_PE; // weak pulldown
- } else if (pin == 20) {
- CORE_PIN20_CONFIG = PORT_PCR_MUX(3) | PORT_PCR_PE; // weak pulldown
- } else {
- UART0_MODEM &= ~UART_MODEM_TXCTSE;
- return 0;
- }
- UART0_MODEM |= UART_MODEM_TXCTSE;
- return 1;
- #else
- return 0;
- #endif
- }
-
- void serial_putchar(uint32_t c)
- {
- uint32_t head, n;
-
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
- if (transmit_pin) transmit_assert();
- head = tx_buffer_head;
- if (++head >= TX_BUFFER_SIZE) head = 0;
- while (tx_buffer_tail == head) {
- int priority = nvic_execution_priority();
- if (priority <= IRQ_PRIORITY) {
- if ((UART0_S1 & UART_S1_TDRE)) {
- uint32_t tail = tx_buffer_tail;
- if (++tail >= TX_BUFFER_SIZE) tail = 0;
- n = tx_buffer[tail];
- if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
- UART0_D = n;
- tx_buffer_tail = tail;
- }
- } else if (priority >= 256) {
- yield();
- }
- }
- tx_buffer[head] = c;
- transmitting = 1;
- tx_buffer_head = head;
- UART0_C2 = C2_TX_ACTIVE;
- }
-
- #ifdef HAS_KINETISK_UART0_FIFO
- void serial_write(const void *buf, unsigned int count)
- {
- const uint8_t *p = (const uint8_t *)buf;
- const uint8_t *end = p + count;
- uint32_t head, n;
-
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
- if (transmit_pin) transmit_assert();
- while (p < end) {
- head = tx_buffer_head;
- if (++head >= TX_BUFFER_SIZE) head = 0;
- if (tx_buffer_tail == head) {
- UART0_C2 = C2_TX_ACTIVE;
- do {
- int priority = nvic_execution_priority();
- if (priority <= IRQ_PRIORITY) {
- if ((UART0_S1 & UART_S1_TDRE)) {
- uint32_t tail = tx_buffer_tail;
- if (++tail >= TX_BUFFER_SIZE) tail = 0;
- n = tx_buffer[tail];
- if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
- UART0_D = n;
- tx_buffer_tail = tail;
- }
- } else if (priority >= 256) {
- yield();
- }
- } while (tx_buffer_tail == head);
- }
- tx_buffer[head] = *p++;
- transmitting = 1;
- tx_buffer_head = head;
- }
- UART0_C2 = C2_TX_ACTIVE;
- }
- #else
- void serial_write(const void *buf, unsigned int count)
- {
- const uint8_t *p = (const uint8_t *)buf;
- while (count-- > 0) serial_putchar(*p++);
- }
- #endif
-
- void serial_flush(void)
- {
- while (transmitting) yield(); // wait
- }
-
- int serial_write_buffer_free(void)
- {
- uint32_t head, tail;
-
- head = tx_buffer_head;
- tail = tx_buffer_tail;
- if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
- return tail - head - 1;
- }
-
- int serial_available(void)
- {
- uint32_t head, tail;
-
- head = rx_buffer_head;
- tail = rx_buffer_tail;
- if (head >= tail) return head - tail;
- return RX_BUFFER_SIZE + head - tail;
- }
-
- int serial_getchar(void)
- {
- uint32_t head, tail;
- int c;
-
- head = rx_buffer_head;
- tail = rx_buffer_tail;
- if (head == tail) return -1;
- if (++tail >= RX_BUFFER_SIZE) tail = 0;
- c = rx_buffer[tail];
- rx_buffer_tail = tail;
- if (rts_pin) {
- int avail;
- if (head >= tail) avail = head - tail;
- else avail = RX_BUFFER_SIZE + head - tail;
- if (avail <= RTS_LOW_WATERMARK) rts_assert();
- }
- return c;
- }
-
- int serial_peek(void)
- {
- uint32_t head, tail;
-
- head = rx_buffer_head;
- tail = rx_buffer_tail;
- if (head == tail) return -1;
- if (++tail >= RX_BUFFER_SIZE) tail = 0;
- return rx_buffer[tail];
- }
-
- void serial_clear(void)
- {
- #ifdef HAS_KINETISK_UART0_FIFO
- if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
- UART0_C2 &= ~(UART_C2_RE | UART_C2_RIE | UART_C2_ILIE);
- UART0_CFIFO = UART_CFIFO_RXFLUSH;
- UART0_C2 |= (UART_C2_RE | UART_C2_RIE | UART_C2_ILIE);
- #endif
- rx_buffer_head = rx_buffer_tail;
- if (rts_pin) rts_assert();
- }
-
- // status interrupt combines
- // Transmit data below watermark UART_S1_TDRE
- // Transmit complete UART_S1_TC
- // Idle line UART_S1_IDLE
- // Receive data above watermark UART_S1_RDRF
- // LIN break detect UART_S2_LBKDIF
- // RxD pin active edge UART_S2_RXEDGIF
-
- void uart0_status_isr(void)
- {
- uint32_t head, tail, n;
- uint8_t c;
- #ifdef HAS_KINETISK_UART0_FIFO
- uint32_t newhead;
- uint8_t avail;
-
- if (UART0_S1 & (UART_S1_RDRF | UART_S1_IDLE)) {
- __disable_irq();
- avail = UART0_RCFIFO;
- if (avail == 0) {
- // The only way to clear the IDLE interrupt flag is
- // to read the data register. But reading with no
- // data causes a FIFO underrun, which causes the
- // FIFO to return corrupted data. If anyone from
- // Freescale reads this, what a poor design! There
- // write should be a write-1-to-clear for IDLE.
- c = UART0_D;
- // flushing the fifo recovers from the underrun,
- // but there's a possible race condition where a
- // new character could be received between reading
- // RCFIFO == 0 and flushing the FIFO. To minimize
- // the chance, interrupts are disabled so a higher
- // priority interrupt (hopefully) doesn't delay.
- // TODO: change this to disabling the IDLE interrupt
- // which won't be simple, since we already manage
- // which transmit interrupts are enabled.
- UART0_CFIFO = UART_CFIFO_RXFLUSH;
- __enable_irq();
- } else {
- __enable_irq();
- head = rx_buffer_head;
- tail = rx_buffer_tail;
- do {
- if (use9Bits && (UART0_C3 & 0x80)) {
- n = UART0_D | 0x100;
- } else {
- n = UART0_D;
- }
- newhead = head + 1;
- if (newhead >= RX_BUFFER_SIZE) newhead = 0;
- if (newhead != tail) {
- head = newhead;
- rx_buffer[head] = n;
- }
- } while (--avail > 0);
- rx_buffer_head = head;
- if (rts_pin) {
- int avail;
- if (head >= tail) avail = head - tail;
- else avail = RX_BUFFER_SIZE + head - tail;
- if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
- }
- }
- }
- c = UART0_C2;
- if ((c & UART_C2_TIE) && (UART0_S1 & UART_S1_TDRE)) {
- head = tx_buffer_head;
- tail = tx_buffer_tail;
- do {
- if (tail == head) break;
- if (++tail >= TX_BUFFER_SIZE) tail = 0;
- avail = UART0_S1;
- n = tx_buffer[tail];
- if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
- UART0_D = n;
- } while (UART0_TCFIFO < 8);
- tx_buffer_tail = tail;
- if (UART0_S1 & UART_S1_TDRE) UART0_C2 = C2_TX_COMPLETING;
- }
- #else
- if (UART0_S1 & UART_S1_RDRF) {
- n = UART0_D;
- if (use9Bits && (UART0_C3 & 0x80)) n |= 0x100;
- head = rx_buffer_head + 1;
- if (head >= RX_BUFFER_SIZE) head = 0;
- if (head != rx_buffer_tail) {
- rx_buffer[head] = n;
- rx_buffer_head = head;
- }
- }
- c = UART0_C2;
- if ((c & UART_C2_TIE) && (UART0_S1 & UART_S1_TDRE)) {
- head = tx_buffer_head;
- tail = tx_buffer_tail;
- if (head == tail) {
- UART0_C2 = C2_TX_COMPLETING;
- } else {
- if (++tail >= TX_BUFFER_SIZE) tail = 0;
- n = tx_buffer[tail];
- if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
- UART0_D = n;
- tx_buffer_tail = tail;
- }
- }
- #endif
- if ((c & UART_C2_TCIE) && (UART0_S1 & UART_S1_TC)) {
- transmitting = 0;
- if (transmit_pin) transmit_deassert();
- UART0_C2 = C2_TX_INACTIVE;
- }
- }
-
-
-
- void serial_print(const char *p)
- {
- while (*p) {
- char c = *p++;
- if (c == '\n') serial_putchar('\r');
- serial_putchar(c);
- }
- }
-
- static void serial_phex1(uint32_t n)
- {
- n &= 15;
- if (n < 10) {
- serial_putchar('0' + n);
- } else {
- serial_putchar('A' - 10 + n);
- }
- }
-
- void serial_phex(uint32_t n)
- {
- serial_phex1(n >> 4);
- serial_phex1(n);
- }
-
- void serial_phex16(uint32_t n)
- {
- serial_phex(n >> 8);
- serial_phex(n);
- }
-
- void serial_phex32(uint32_t n)
- {
- serial_phex(n >> 24);
- serial_phex(n >> 16);
- serial_phex(n >> 8);
- serial_phex(n);
- }
-
|