Browse Source

serialX buffersizes

Additional PR for SERIALX_DISABLE follows
main
Frank Bösing 8 years ago
parent
commit
6dd6073c2c
8 changed files with 171 additions and 139 deletions
  1. +24
    -20
      teensy3/serial1.c
  2. +23
    -19
      teensy3/serial1_doughboy.txt
  3. +24
    -20
      teensy3/serial2.c
  4. +20
    -16
      teensy3/serial3.c
  5. +20
    -16
      teensy3/serial4.c
  6. +20
    -16
      teensy3/serial5.c
  7. +20
    -16
      teensy3/serial6.c
  8. +20
    -16
      teensy3/serial6_lpuart.c

+ 24
- 20
teensy3/serial1.c View File

// Tunable parameters (relatively safe to edit these numbers) // 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
#ifndef SERIAL1_TX_BUFFER_SIZE
#define SERIAL1_TX_BUFFER_SIZE 64 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL1_RX_BUFFER_SIZE
#define SERIAL1_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL1_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL1_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
#if defined(KINETISK) #if defined(KINETISK)
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define rts_assert() *(rts_pin+8) = rts_mask; #define rts_assert() *(rts_pin+8) = rts_mask;
#define rts_deassert() *(rts_pin+4) = rts_mask; #define rts_deassert() *(rts_pin+4) = rts_mask;
#endif #endif
#if TX_BUFFER_SIZE > 255
#if SERIAL1_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL1_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return; if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL1_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART0_S1 & UART_S1_TDRE)) { if ((UART0_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
while (p < end) { while (p < end) {
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL1_TX_BUFFER_SIZE) head = 0;
if (tx_buffer_tail == head) { if (tx_buffer_tail == head) {
UART0_C2 = C2_TX_ACTIVE; UART0_C2 = C2_TX_ACTIVE;
do { do {
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART0_S1 & UART_S1_TDRE)) { if ((UART0_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL1_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL1_RX_BUFFER_SIZE + head - tail;
} }


int serial_getchar(void) int serial_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL1_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART0_D; n = UART0_D;
} }
newhead = head + 1; newhead = head + 1;
if (newhead >= RX_BUFFER_SIZE) newhead = 0;
if (newhead >= SERIAL1_RX_BUFFER_SIZE) newhead = 0;
if (newhead != tail) { if (newhead != tail) {
head = newhead; head = newhead;
rx_buffer[head] = n; rx_buffer[head] = n;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL1_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
tail = tx_buffer_tail; tail = tx_buffer_tail;
do { do {
if (tail == head) break; if (tail == head) break;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
avail = UART0_S1; avail = UART0_S1;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
n = UART0_D; n = UART0_D;
if (use9Bits && (UART0_C3 & 0x80)) n |= 0x100; if (use9Bits && (UART0_C3 & 0x80)) n |= 0x100;
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL1_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
if (head == tail) { if (head == tail) {
UART0_C2 = C2_TX_COMPLETING; UART0_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;

+ 23
- 19
teensy3/serial1_doughboy.txt View File

// Tunable parameters (relatively safe to edit these numbers) // 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
#ifndef SERIAL1_TX_BUFFER_SIZE
#define SERIAL1_TX_BUFFER_SIZE 64 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL1_RX_BUFFER_SIZE
#define SERIAL1_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest




#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL1_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL1_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
#if defined(KINETISK) #if defined(KINETISK)
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define transmit_assert() *(transmit_pin+4) = transmit_mask; #define transmit_assert() *(transmit_pin+4) = transmit_mask;
#define transmit_deassert() *(transmit_pin+8) = transmit_mask; #define transmit_deassert() *(transmit_pin+8) = transmit_mask;
#endif #endif
#if TX_BUFFER_SIZE > 255
#if SERIAL1_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL1_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return; if (!(SIM_SCGC4 & SIM_SCGC4_UART0)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL1_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART0_S1 & UART_S1_TDRE)) { if ((UART0_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
while (p < end) { while (p < end) {
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL1_TX_BUFFER_SIZE) head = 0;
if (tx_buffer_tail == head) { if (tx_buffer_tail == head) {
UART0_C2 |= UART_C2_TIE; UART0_C2 |= UART_C2_TIE;
UART0_C2 &= ~UART_C2_TCIE; UART0_C2 &= ~UART_C2_TCIE;
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART0_S1 & UART_S1_TDRE)) { if ((UART0_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL1_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL1_RX_BUFFER_SIZE + head - tail;
} }


int serial_getchar(void) int serial_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
#ifdef HAS_KINETISK_UART0_FIFO #ifdef HAS_KINETISK_UART0_FIFO
if ((UART0_C2 & (UART_C2_RIE | UART_C2_ILIE))==0) {//rx interrupt currently disabled if ((UART0_C2 & (UART_C2_RIE | UART_C2_ILIE))==0) {//rx interrupt currently disabled
int freespace; int freespace;
if (head >= tail) //rx head and tail would be unchanged from above if interrupts were disabled if (head >= tail) //rx head and tail would be unchanged from above if interrupts were disabled
freespace = RX_BUFFER_SIZE -1 + tail - head;
freespace = SERIAL1_RX_BUFFER_SIZE -1 + tail - head;
else else
freespace = tail - head - 1; freespace = tail - head - 1;
if (freespace >= UART0_RCFIFO) { if (freespace >= UART0_RCFIFO) {
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


tail = rx_buffer_tail; tail = rx_buffer_tail;
do { do {
newhead = head + 1; newhead = head + 1;
if (newhead >= RX_BUFFER_SIZE) newhead = 0;
if (newhead >= SERIAL1_RX_BUFFER_SIZE) newhead = 0;
if (UART0_MODEM & UART_MODEM_RXRTSE) { if (UART0_MODEM & UART_MODEM_RXRTSE) {
if (newhead == tail) { if (newhead == tail) {
UART0_C2 &= ~(UART_C2_RIE | UART_C2_ILIE);//disable rx interrupts UART0_C2 &= ~(UART_C2_RIE | UART_C2_ILIE);//disable rx interrupts
tail = tx_buffer_tail; tail = tx_buffer_tail;
do { do {
if (tail == head) break; if (tail == head) break;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
UART0_S1; UART0_S1;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
if (UART0_S1 & UART_S1_RDRF) { if (UART0_S1 & UART_S1_RDRF) {
do { do {
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL1_RX_BUFFER_SIZE) head = 0;
if (UART0_MODEM & UART_MODEM_RXRTSE) { if (UART0_MODEM & UART_MODEM_RXRTSE) {
if (head == rx_buffer_tail) { if (head == rx_buffer_tail) {
UART0_C2 &= ~(UART_C2_RIE);//disable rx interrupts UART0_C2 &= ~(UART_C2_RIE);//disable rx interrupts
UART0_C2 |= UART_C2_TCIE; UART0_C2 |= UART_C2_TCIE;
UART0_C2 &= ~UART_C2_TIE; UART0_C2 &= ~UART_C2_TIE;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART0_C3 = (UART0_C3 & ~0x40) | ((n & 0x100) >> 2);
UART0_D = n; UART0_D = n;

+ 24
- 20
teensy3/serial2.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL2_TX_BUFFER_SIZE
#define SERIAL2_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL2_RX_BUFFER_SIZE
#define SERIAL2_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL2_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL2_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
#if defined(KINETISK) #if defined(KINETISK)
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define rts_assert() *(rts_pin+8) = rts_mask; #define rts_assert() *(rts_pin+8) = rts_mask;
#define rts_deassert() *(rts_pin+4) = rts_mask; #define rts_deassert() *(rts_pin+4) = rts_mask;
#endif #endif
#if TX_BUFFER_SIZE > 255
#if SERIAL2_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL2_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return; if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL2_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART1_S1 & UART_S1_TDRE)) { if ((UART1_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
UART1_D = n; UART1_D = n;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
while (p < end) { while (p < end) {
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL2_TX_BUFFER_SIZE) head = 0;
if (tx_buffer_tail == head) { if (tx_buffer_tail == head) {
UART1_C2 = C2_TX_ACTIVE; UART1_C2 = C2_TX_ACTIVE;
do { do {
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART1_S1 & UART_S1_TDRE)) { if ((UART1_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
UART1_D = n; UART1_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL2_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL2_RX_BUFFER_SIZE + head - tail;
} }


int serial2_getchar(void) int serial2_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL2_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART1_D; n = UART1_D;
} }
newhead = head + 1; newhead = head + 1;
if (newhead >= RX_BUFFER_SIZE) newhead = 0;
if (newhead >= SERIAL2_RX_BUFFER_SIZE) newhead = 0;
if (newhead != tail) { if (newhead != tail) {
head = newhead; head = newhead;
rx_buffer[head] = n; rx_buffer[head] = n;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL2_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
tail = tx_buffer_tail; tail = tx_buffer_tail;
do { do {
if (tail == head) break; if (tail == head) break;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
avail = UART1_S1; avail = UART1_S1;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
n = UART1_D; n = UART1_D;
if (use9Bits && (UART1_C3 & 0x80)) n |= 0x100; if (use9Bits && (UART1_C3 & 0x80)) n |= 0x100;
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL2_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
if (head == tail) { if (head == tail) {
UART1_C2 = C2_TX_COMPLETING; UART1_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
UART1_D = n; UART1_D = n;

+ 20
- 16
teensy3/serial3.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL3_TX_BUFFER_SIZE
#define SERIAL3_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL3_RX_BUFFER_SIZE
#define SERIAL3_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL3_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL3_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
#if defined(KINETISK) #if defined(KINETISK)
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define rts_assert() *(rts_pin+8) = rts_mask; #define rts_assert() *(rts_pin+8) = rts_mask;
#define rts_deassert() *(rts_pin+4) = rts_mask; #define rts_deassert() *(rts_pin+4) = rts_mask;
#endif #endif
#if TX_BUFFER_SIZE > 255
#if SERIAL3_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL3_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC4 & SIM_SCGC4_UART2)) return; if (!(SIM_SCGC4 & SIM_SCGC4_UART2)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL3_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART2_S1 & UART_S1_TDRE)) { if ((UART2_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL3_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART2_C3 = (UART2_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART2_C3 = (UART2_C3 & ~0x40) | ((n & 0x100) >> 2);
UART2_D = n; UART2_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL3_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL3_RX_BUFFER_SIZE + head - tail;
} }


int serial3_getchar(void) int serial3_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL3_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL3_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL3_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART2_D; n = UART2_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL3_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
int avail; int avail;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL3_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
if (head == tail) { if (head == tail) {
UART2_C2 = C2_TX_COMPLETING; UART2_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL3_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART2_C3 = (UART2_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART2_C3 = (UART2_C3 & ~0x40) | ((n & 0x100) >> 2);
UART2_D = n; UART2_D = n;

+ 20
- 16
teensy3/serial4.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL4_TX_BUFFER_SIZE
#define SERIAL4_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL4_RX_BUFFER_SIZE
#define SERIAL4_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL4_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL4_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define transmit_assert() *transmit_pin = 1 #define transmit_assert() *transmit_pin = 1
static volatile uint8_t *rts_pin=NULL; static volatile uint8_t *rts_pin=NULL;
#define rts_assert() *rts_pin = 0 #define rts_assert() *rts_pin = 0
#define rts_deassert() *rts_pin = 1 #define rts_deassert() *rts_pin = 1
#if TX_BUFFER_SIZE > 255
#if SERIAL4_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL4_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC4 & SIM_SCGC4_UART3)) return; if (!(SIM_SCGC4 & SIM_SCGC4_UART3)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL4_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART3_S1 & UART_S1_TDRE)) { if ((UART3_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL4_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART3_C3 = (UART3_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART3_C3 = (UART3_C3 & ~0x40) | ((n & 0x100) >> 2);
UART3_D = n; UART3_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL4_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL4_RX_BUFFER_SIZE + head - tail;
} }


int serial4_getchar(void) int serial4_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL4_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL4_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL4_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART3_D; n = UART3_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL4_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
int avail; int avail;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL4_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
if (head == tail) { if (head == tail) {
UART3_C2 = C2_TX_COMPLETING; UART3_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL4_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART3_C3 = (UART3_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART3_C3 = (UART3_C3 & ~0x40) | ((n & 0x100) >> 2);
UART3_D = n; UART3_D = n;

+ 20
- 16
teensy3/serial5.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL5_TX_BUFFER_SIZE
#define SERIAL5_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL5_RX_BUFFER_SIZE
#define SERIAL5_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL5_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL5_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define transmit_assert() *transmit_pin = 1 #define transmit_assert() *transmit_pin = 1
static volatile uint8_t *rts_pin=NULL; static volatile uint8_t *rts_pin=NULL;
#define rts_assert() *rts_pin = 0 #define rts_assert() *rts_pin = 0
#define rts_deassert() *rts_pin = 1 #define rts_deassert() *rts_pin = 1
#if TX_BUFFER_SIZE > 255
#if SERIAL5_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL5_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC1 & SIM_SCGC1_UART4)) return; if (!(SIM_SCGC1 & SIM_SCGC1_UART4)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL5_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART4_S1 & UART_S1_TDRE)) { if ((UART4_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL5_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART4_C3 = (UART4_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART4_C3 = (UART4_C3 & ~0x40) | ((n & 0x100) >> 2);
UART4_D = n; UART4_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL5_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL5_RX_BUFFER_SIZE + head - tail;
} }


int serial5_getchar(void) int serial5_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL5_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL5_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL5_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART4_D; n = UART4_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL5_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
int avail; int avail;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL5_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
if (head == tail) { if (head == tail) {
UART4_C2 = C2_TX_COMPLETING; UART4_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL5_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART4_C3 = (UART4_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART4_C3 = (UART4_C3 & ~0x40) | ((n & 0x100) >> 2);
UART4_D = n; UART4_D = n;

+ 20
- 16
teensy3/serial6.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL6_TX_BUFFER_SIZE
#define SERIAL6_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL6_RX_BUFFER_SIZE
#define SERIAL6_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define transmit_assert() *transmit_pin = 1 #define transmit_assert() *transmit_pin = 1
static volatile uint8_t *rts_pin=NULL; static volatile uint8_t *rts_pin=NULL;
#define rts_assert() *rts_pin = 0 #define rts_assert() *rts_pin = 0
#define rts_deassert() *rts_pin = 1 #define rts_deassert() *rts_pin = 1
#if TX_BUFFER_SIZE > 255
#if SERIAL6_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL6_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC1 & SIM_SCGC1_UART5)) return; if (!(SIM_SCGC1 & SIM_SCGC1_UART5)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL6_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((UART5_S1 & UART_S1_TDRE)) { if ((UART5_S1 & UART_S1_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2);
UART5_D = n; UART5_D = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL6_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL6_RX_BUFFER_SIZE + head - tail;
} }


int serial6_getchar(void) int serial6_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


n = UART5_D; n = UART5_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL6_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
int avail; int avail;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
if (head == tail) { if (head == tail) {
UART5_C2 = C2_TX_COMPLETING; UART5_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2); if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2);
UART5_D = n; UART5_D = n;

+ 20
- 16
teensy3/serial6_lpuart.c View File

// Tunable parameters (relatively safe to edit these numbers) // Tunable parameters (relatively safe to edit these numbers)
//////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////


#define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#ifndef SERIAL6_TX_BUFFER_SIZE
#define SERIAL6_TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
#endif
#ifndef SERIAL6_RX_BUFFER_SIZE
#define SERIAL6_RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
#endif
#define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
#define RTS_LOW_WATERMARK 26 // RTS allows sender to resume #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
#define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
#define use9Bits 0 #define use9Bits 0
#endif #endif


static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE];
static volatile uint8_t transmitting = 0; static volatile uint8_t transmitting = 0;
static volatile uint8_t *transmit_pin=NULL; static volatile uint8_t *transmit_pin=NULL;
#define transmit_assert() *transmit_pin = 1 #define transmit_assert() *transmit_pin = 1
static volatile uint8_t *rts_pin=NULL; static volatile uint8_t *rts_pin=NULL;
#define rts_assert() *rts_pin = 0 #define rts_assert() *rts_pin = 0
#define rts_deassert() *rts_pin = 1 #define rts_deassert() *rts_pin = 1
#if TX_BUFFER_SIZE > 255
#if SERIAL6_TX_BUFFER_SIZE > 255
static volatile uint16_t tx_buffer_head = 0; static volatile uint16_t tx_buffer_head = 0;
static volatile uint16_t tx_buffer_tail = 0; static volatile uint16_t tx_buffer_tail = 0;
#else #else
static volatile uint8_t tx_buffer_head = 0; static volatile uint8_t tx_buffer_head = 0;
static volatile uint8_t tx_buffer_tail = 0; static volatile uint8_t tx_buffer_tail = 0;
#endif #endif
#if RX_BUFFER_SIZE > 255
#if SERIAL6_RX_BUFFER_SIZE > 255
static volatile uint16_t rx_buffer_head = 0; static volatile uint16_t rx_buffer_head = 0;
static volatile uint16_t rx_buffer_tail = 0; static volatile uint16_t rx_buffer_tail = 0;
#else #else
if (!(SIM_SCGC2 & SIM_SCGC2_LPUART0)) return; if (!(SIM_SCGC2 & SIM_SCGC2_LPUART0)) return;
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= TX_BUFFER_SIZE) head = 0;
if (++head >= SERIAL6_TX_BUFFER_SIZE) head = 0;
while (tx_buffer_tail == head) { while (tx_buffer_tail == head) {
int priority = nvic_execution_priority(); int priority = nvic_execution_priority();
if (priority <= IRQ_PRIORITY) { if (priority <= IRQ_PRIORITY) {
if ((LPUART0_STAT & LPUART_STAT_TDRE)) { if ((LPUART0_STAT & LPUART_STAT_TDRE)) {
uint32_t tail = tx_buffer_tail; uint32_t tail = tx_buffer_tail;
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
//if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2); //if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2);
LPUART0_DATA = n; LPUART0_DATA = n;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return SERIAL6_TX_BUFFER_SIZE - 1 - head + tail;
return tail - head - 1; return tail - head - 1;
} }


head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head >= tail) return head - tail; if (head >= tail) return head - tail;
return RX_BUFFER_SIZE + head - tail;
return SERIAL6_RX_BUFFER_SIZE + head - tail;
} }


int serial6_getchar(void) int serial6_getchar(void)
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail]; c = rx_buffer[tail];
rx_buffer_tail = tail; rx_buffer_tail = tail;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert(); if (avail <= RTS_LOW_WATERMARK) rts_assert();
} }
return c; return c;
head = rx_buffer_head; head = rx_buffer_head;
tail = rx_buffer_tail; tail = rx_buffer_tail;
if (head == tail) return -1; if (head == tail) return -1;
if (++tail >= RX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail]; return rx_buffer[tail];
} }


// } // }
n = LPUART0_DATA & 0x3ff; // use only the 10 data bits n = LPUART0_DATA & 0x3ff; // use only the 10 data bits
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= RX_BUFFER_SIZE) head = 0;
if (head >= SERIAL6_RX_BUFFER_SIZE) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n; rx_buffer[head] = n;
rx_buffer_head = head; rx_buffer_head = head;
int avail; int avail;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = RX_BUFFER_SIZE + head - tail;
else avail = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert(); if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
} }
} }
//LPUART0_CTRL &= ~LPUART_CTRL_TIE; //LPUART0_CTRL &= ~LPUART_CTRL_TIE;
//LPUART0_CTRL |= LPUART_CTRL_TCIE; // Actually wondering if we can just leave this one on... //LPUART0_CTRL |= LPUART_CTRL_TCIE; // Actually wondering if we can just leave this one on...
} else { } else {
if (++tail >= TX_BUFFER_SIZE) tail = 0;
if (++tail >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail]; n = tx_buffer[tail];
//if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2); //if (use9Bits) UART5_C3 = (UART5_C3 & ~0x40) | ((n & 0x100) >> 2);
LPUART0_DATA = n; LPUART0_DATA = n;

Loading…
Cancel
Save