Browse Source

Merge pull request #500 from KurtE/T3X_SerialX_AddMemory

T3 x serial x add memory
teensy4-core
Paul Stoffregen 4 years ago
parent
commit
ce30cc41e0
No account linked to committer's email address
10 changed files with 592 additions and 141 deletions
  1. +4
    -0
      teensy3/HardwareSerial.cpp
  2. +25
    -0
      teensy3/HardwareSerial.h
  3. +97
    -26
      teensy3/serial1.c
  4. +97
    -26
      teensy3/serial2.c
  5. +73
    -18
      teensy3/serial3.c
  6. +74
    -18
      teensy3/serial4.c
  7. +75
    -18
      teensy3/serial5.c
  8. +75
    -18
      teensy3/serial6.c
  9. +69
    -17
      teensy3/serial6_lpuart.c
  10. +3
    -0
      teensy4/HardwareSerial.cpp

+ 4
- 0
teensy3/HardwareSerial.cpp View File

// simple helper function that add us to the list of Serial ports that have // simple helper function that add us to the list of Serial ports that have
// their own serialEvent code defined that needs to be called at yield. // their own serialEvent code defined that needs to be called at yield.
void HardwareSerial::addToSerialEventsList() { void HardwareSerial::addToSerialEventsList() {
for (uint8_t i = 0; i < s_count_serials_with_serial_events; i++) {
if (s_serials_with_serial_events[i] == this) return; // already in the list.
}

s_serials_with_serial_events[s_count_serials_with_serial_events++] = this; s_serials_with_serial_events[s_count_serials_with_serial_events++] = this;
yield_active_check_flags |= YIELD_CHECK_HARDWARE_SERIAL; yield_active_check_flags |= YIELD_CHECK_HARDWARE_SERIAL;
} }

+ 25
- 0
teensy3/HardwareSerial.h View File

#define HardwareSerial_h #define HardwareSerial_h


#include "kinetis.h" #include "kinetis.h"
#include <stddef.h>


// Uncomment to enable 9 bit formats. These are default disabled to save memory. // Uncomment to enable 9 bit formats. These are default disabled to save memory.
//#define SERIAL_9BIT_SUPPORT //#define SERIAL_9BIT_SUPPORT
void serial_write(const void *buf, unsigned int count); void serial_write(const void *buf, unsigned int count);
void serial_flush(void); void serial_flush(void);
int serial_write_buffer_free(void); int serial_write_buffer_free(void);
void serial_add_memory_for_read(void *buffer, size_t length);
void serial_add_memory_for_write(void *buffer, size_t length);
int serial_available(void); int serial_available(void);
int serial_getchar(void); int serial_getchar(void);
int serial_peek(void); int serial_peek(void);
void serial2_write(const void *buf, unsigned int count); void serial2_write(const void *buf, unsigned int count);
void serial2_flush(void); void serial2_flush(void);
int serial2_write_buffer_free(void); int serial2_write_buffer_free(void);
void serial2_add_memory_for_read(void *buffer, size_t length);
void serial2_add_memory_for_write(void *buffer, size_t length);
int serial2_available(void); int serial2_available(void);
int serial2_getchar(void); int serial2_getchar(void);
int serial2_peek(void); int serial2_peek(void);
void serial3_write(const void *buf, unsigned int count); void serial3_write(const void *buf, unsigned int count);
void serial3_flush(void); void serial3_flush(void);
int serial3_write_buffer_free(void); int serial3_write_buffer_free(void);
void serial3_add_memory_for_read(void *buffer, size_t length);
void serial3_add_memory_for_write(void *buffer, size_t length);
int serial3_available(void); int serial3_available(void);
int serial3_getchar(void); int serial3_getchar(void);
int serial3_peek(void); int serial3_peek(void);
void serial4_write(const void *buf, unsigned int count); void serial4_write(const void *buf, unsigned int count);
void serial4_flush(void); void serial4_flush(void);
int serial4_write_buffer_free(void); int serial4_write_buffer_free(void);
void serial4_add_memory_for_read(void *buffer, size_t length);
void serial4_add_memory_for_write(void *buffer, size_t length);
int serial4_available(void); int serial4_available(void);
int serial4_getchar(void); int serial4_getchar(void);
int serial4_peek(void); int serial4_peek(void);
void serial5_write(const void *buf, unsigned int count); void serial5_write(const void *buf, unsigned int count);
void serial5_flush(void); void serial5_flush(void);
int serial5_write_buffer_free(void); int serial5_write_buffer_free(void);
void serial5_add_memory_for_read(void *buffer, size_t length);
void serial5_add_memory_for_write(void *buffer, size_t length);
int serial5_available(void); int serial5_available(void);
int serial5_getchar(void); int serial5_getchar(void);
int serial5_peek(void); int serial5_peek(void);
void serial6_write(const void *buf, unsigned int count); void serial6_write(const void *buf, unsigned int count);
void serial6_flush(void); void serial6_flush(void);
int serial6_write_buffer_free(void); int serial6_write_buffer_free(void);
void serial6_add_memory_for_read(void *buffer, size_t length);
void serial6_add_memory_for_write(void *buffer, size_t length);
int serial6_available(void); int serial6_available(void);
int serial6_getchar(void); int serial6_getchar(void);
int serial6_peek(void); int serial6_peek(void);
virtual void flush(void) { serial_flush(); } virtual void flush(void) { serial_flush(); }
virtual void clear(void) { serial_clear(); } virtual void clear(void) { serial_clear(); }
virtual int availableForWrite(void) { return serial_write_buffer_free(); } virtual int availableForWrite(void) { return serial_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }
virtual void flush(void) { serial2_flush(); } virtual void flush(void) { serial2_flush(); }
virtual void clear(void) { serial2_clear(); } virtual void clear(void) { serial2_clear(); }
virtual int availableForWrite(void) { return serial2_write_buffer_free(); } virtual int availableForWrite(void) { return serial2_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial2_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial2_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial2_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial2_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }
virtual void flush(void) { serial3_flush(); } virtual void flush(void) { serial3_flush(); }
virtual void clear(void) { serial3_clear(); } virtual void clear(void) { serial3_clear(); }
virtual int availableForWrite(void) { return serial3_write_buffer_free(); } virtual int availableForWrite(void) { return serial3_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial3_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial3_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial3_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial3_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }
virtual void flush(void) { serial4_flush(); } virtual void flush(void) { serial4_flush(); }
virtual void clear(void) { serial4_clear(); } virtual void clear(void) { serial4_clear(); }
virtual int availableForWrite(void) { return serial4_write_buffer_free(); } virtual int availableForWrite(void) { return serial4_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial4_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial4_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial4_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial4_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }
virtual void flush(void) { serial5_flush(); } virtual void flush(void) { serial5_flush(); }
virtual void clear(void) { serial5_clear(); } virtual void clear(void) { serial5_clear(); }
virtual int availableForWrite(void) { return serial5_write_buffer_free(); } virtual int availableForWrite(void) { return serial5_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial5_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial5_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial5_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial5_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }
virtual void flush(void) { serial6_flush(); } virtual void flush(void) { serial6_flush(); }
virtual void clear(void) { serial6_clear(); } virtual void clear(void) { serial6_clear(); }
virtual int availableForWrite(void) { return serial6_write_buffer_free(); } virtual int availableForWrite(void) { return serial6_write_buffer_free(); }
virtual void addMemoryForRead(void *buffer, size_t length) {serial6_add_memory_for_read(buffer, length);}
virtual void addMemoryForWrite(void *buffer, size_t length){serial6_add_memory_for_write(buffer, length);}
using Print::write; using Print::write;
virtual size_t write(uint8_t c) { serial6_putchar(c); return 1; } virtual size_t write(uint8_t c) { serial6_putchar(c); return 1; }
virtual size_t write(unsigned long n) { return write((uint8_t)n); } virtual size_t write(unsigned long n) { return write((uint8_t)n); }

+ 97
- 26
teensy3/serial1.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


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


static volatile BUFTYPE tx_buffer[SERIAL1_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL1_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL1_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL1_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL1_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL1_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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;
} }
#endif #endif
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= SERIAL1_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL1_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL1_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); yield();
} }
} }
tx_buffer[head] = c;
if (head < SERIAL1_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL1_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART0_C2 = C2_TX_ACTIVE; UART0_C2 = C2_TX_ACTIVE;
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 >= SERIAL1_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL1_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL1_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} while (tx_buffer_tail == head); } while (tx_buffer_tail == head);
} }
tx_buffer[head] = *p++;
if (head < SERIAL1_TX_BUFFER_SIZE) {
tx_buffer[head] = *p++;
} else {
tx_buffer_storage_[head - SERIAL1_TX_BUFFER_SIZE] = *p++;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
} }


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL1_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL1_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL1_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL1_RX_BUFFER_SIZE];
}
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 = SERIAL1_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL1_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL1_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL1_RX_BUFFER_SIZE];
} }


void serial_clear(void) void serial_clear(void)
n = UART0_D; n = UART0_D;
} }
newhead = head + 1; newhead = head + 1;
if (newhead >= SERIAL1_RX_BUFFER_SIZE) newhead = 0;
if (newhead >= rx_buffer_total_size_) newhead = 0;
if (newhead != tail) { if (newhead != tail) {
head = newhead; head = newhead;
rx_buffer[head] = n;
if (newhead < SERIAL1_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL1_RX_BUFFER_SIZE] = n;
}
} }
} while (--avail > 0); } while (--avail > 0);
rx_buffer_head = head; rx_buffer_head = head;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = SERIAL1_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
if (++tail >= tx_buffer_total_size_) tail = 0;
avail = UART0_S1; avail = UART0_S1;
n = tx_buffer[tail];
if (tail < SERIAL1_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL1_TX_BUFFER_SIZE];
}
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;
} while (UART0_TCFIFO < 8); } while (UART0_TCFIFO < 8);
n = UART0_D; n = UART0_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL1_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL1_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL1_RX_BUFFER_SIZE] = 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 >= SERIAL1_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL1_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL1_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
serial_phex(n); serial_phex(n);
} }


void serial_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL1_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL1_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL1_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL1_TX_BUFFER_SIZE;
}
}

+ 97
- 26
teensy3/serial2.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


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


static volatile BUFTYPE tx_buffer[SERIAL2_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL2_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL2_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL2_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL2_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL2_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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;
} }
#endif #endif
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= SERIAL2_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL2_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL2_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); // wait yield(); // wait
} }
} }
tx_buffer[head] = c;
if (head < SERIAL2_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL2_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART1_C2 = C2_TX_ACTIVE; UART1_C2 = C2_TX_ACTIVE;
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 >= SERIAL2_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL2_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL2_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} while (tx_buffer_tail == head); } while (tx_buffer_tail == head);
} }
tx_buffer[head] = *p++;
if (head < SERIAL2_TX_BUFFER_SIZE) {
tx_buffer[head] = *p++;
} else {
tx_buffer_storage_[head - SERIAL2_TX_BUFFER_SIZE] = *p++;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
} }


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL2_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL2_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL2_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL2_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL2_RX_BUFFER_SIZE];
}
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 = SERIAL2_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL2_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL2_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL2_RX_BUFFER_SIZE];
} }


void serial2_clear(void) void serial2_clear(void)
n = UART1_D; n = UART1_D;
} }
newhead = head + 1; newhead = head + 1;
if (newhead >= SERIAL2_RX_BUFFER_SIZE) newhead = 0;
if (newhead >= rx_buffer_total_size_) newhead = 0;
if (newhead != tail) { if (newhead != tail) {
head = newhead; head = newhead;
rx_buffer[head] = n;
if (newhead < SERIAL2_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL2_RX_BUFFER_SIZE] = n;
}
} }
} while (--avail > 0); } while (--avail > 0);
rx_buffer_head = head; rx_buffer_head = head;
if (rts_pin) { if (rts_pin) {
int avail; int avail;
if (head >= tail) avail = head - tail; if (head >= tail) avail = head - tail;
else avail = SERIAL2_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
if (++tail >= tx_buffer_total_size_) tail = 0;
avail = UART1_S1; avail = UART1_S1;
n = tx_buffer[tail];
if (tail < SERIAL2_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL2_TX_BUFFER_SIZE];
}
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;
} while (UART1_TCFIFO < 8); } while (UART1_TCFIFO < 8);
n = UART1_D; n = UART1_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL2_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL2_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL2_RX_BUFFER_SIZE] = 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 >= SERIAL2_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL2_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL2_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial2_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL2_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL2_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial2_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL2_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL2_TX_BUFFER_SIZE;
}
}



+ 73
- 18
teensy3/serial3.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


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


static volatile BUFTYPE tx_buffer[SERIAL3_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL3_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL3_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL3_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL3_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL3_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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;
} }
#endif #endif
head = tx_buffer_head; head = tx_buffer_head;
if (++head >= SERIAL3_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL3_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL3_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL3_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); // wait yield(); // wait
} }
} }
tx_buffer[head] = c;
if (head < SERIAL3_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL3_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART2_C2 = C2_TX_ACTIVE; UART2_C2 = C2_TX_ACTIVE;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL3_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL3_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL3_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL3_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL3_RX_BUFFER_SIZE];
}
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 = SERIAL3_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL3_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL3_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL3_RX_BUFFER_SIZE];
} }


void serial3_clear(void) void serial3_clear(void)
n = UART2_D; n = UART2_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL3_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL3_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL3_RX_BUFFER_SIZE] = n;
}

rx_buffer_head = head; rx_buffer_head = head;
} }
if (rts_pin) { if (rts_pin) {
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 = SERIAL3_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
if (avail >= rts_high_watermark_) rts_deassert();
} }
} }
c = UART2_C2; c = UART2_C2;
if (head == tail) { if (head == tail) {
UART2_C2 = C2_TX_COMPLETING; UART2_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= SERIAL3_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL3_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL3_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial3_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL3_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL3_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial3_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL3_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL3_TX_BUFFER_SIZE;
}
}



+ 74
- 18
teensy3/serial4.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


#ifdef HAS_KINETISK_UART3 #ifdef HAS_KINETISK_UART3




static volatile BUFTYPE tx_buffer[SERIAL4_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL4_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL4_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL4_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL4_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL4_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;
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
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 >= SERIAL4_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL4_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL4_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL4_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); // wait yield(); // wait
} }
} }
tx_buffer[head] = c;
if (head < SERIAL4_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL4_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART3_C2 = C2_TX_ACTIVE; UART3_C2 = C2_TX_ACTIVE;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL4_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL4_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL4_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL4_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL4_RX_BUFFER_SIZE];
}
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 = SERIAL4_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL4_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL4_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL4_RX_BUFFER_SIZE];
} }


void serial4_clear(void) void serial4_clear(void)
n = UART3_D; n = UART3_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL4_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL4_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL4_RX_BUFFER_SIZE] = n;
}

rx_buffer_head = head; rx_buffer_head = head;
} }
if (rts_pin) { if (rts_pin) {
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 = SERIAL4_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
if (avail >= rts_high_watermark_) rts_deassert();
} }
} }
c = UART3_C2; c = UART3_C2;
if (head == tail) { if (head == tail) {
UART3_C2 = C2_TX_COMPLETING; UART3_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= SERIAL4_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL4_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL4_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial4_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL4_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL4_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial4_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL4_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL4_TX_BUFFER_SIZE;
}
}


#endif // HAS_KINETISK_UART3 #endif // HAS_KINETISK_UART3

+ 75
- 18
teensy3/serial5.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


#ifdef HAS_KINETISK_UART4 #ifdef HAS_KINETISK_UART4




static volatile BUFTYPE tx_buffer[SERIAL5_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL5_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL5_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL5_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL5_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL5_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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
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 >= SERIAL5_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL5_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL5_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL5_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); // wait yield(); // wait
} }
} }
tx_buffer[head] = c;
if (head < SERIAL5_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL5_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART4_C2 = C2_TX_ACTIVE; UART4_C2 = C2_TX_ACTIVE;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL5_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL5_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL5_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL5_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL5_RX_BUFFER_SIZE];
}
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 = SERIAL5_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL5_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL5_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL5_RX_BUFFER_SIZE];
} }


void serial5_clear(void) void serial5_clear(void)
n = UART4_D; n = UART4_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL5_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL5_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL5_RX_BUFFER_SIZE] = n;
}

rx_buffer_head = head; rx_buffer_head = head;
} }
if (rts_pin) { if (rts_pin) {
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 = SERIAL5_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
if (avail >= rts_high_watermark_) rts_deassert();
} }
} }
c = UART4_C2; c = UART4_C2;
if (head == tail) { if (head == tail) {
UART4_C2 = C2_TX_COMPLETING; UART4_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= SERIAL5_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL5_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL5_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial5_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL5_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL5_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial5_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL5_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL5_TX_BUFFER_SIZE;
}
}


#endif // HAS_KINETISK_UART4 #endif // HAS_KINETISK_UART4

+ 75
- 18
teensy3/serial6.c View File

#include "kinetis.h" #include "kinetis.h"
#include "core_pins.h" #include "core_pins.h"
#include "HardwareSerial.h" #include "HardwareSerial.h"
#include <stddef.h>


#ifdef HAS_KINETISK_UART5 #ifdef HAS_KINETISK_UART5




static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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
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 >= SERIAL6_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL6_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
yield(); // wait yield(); // wait
} }
} }
tx_buffer[head] = c;
if (head < SERIAL6_TX_BUFFER_SIZE) {
tx_buffer[head] = c;
} else {
tx_buffer_storage_[head - SERIAL6_TX_BUFFER_SIZE] = c;
}
transmitting = 1; transmitting = 1;
tx_buffer_head = head; tx_buffer_head = head;
UART5_C2 = C2_TX_ACTIVE; UART5_C2 = C2_TX_ACTIVE;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL6_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL6_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL6_RX_BUFFER_SIZE];
}
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 = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL6_RX_BUFFER_SIZE];
} }


void serial6_clear(void) void serial6_clear(void)
n = UART5_D; n = UART5_D;
} }
head = rx_buffer_head + 1; head = rx_buffer_head + 1;
if (head >= SERIAL6_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL6_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL6_RX_BUFFER_SIZE] = n;
}

rx_buffer_head = head; rx_buffer_head = head;
} }
if (rts_pin) { if (rts_pin) {
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 = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
if (avail >= rts_high_watermark_) rts_deassert();
} }
} }
c = UART5_C2; c = UART5_C2;
if (head == tail) { if (head == tail) {
UART5_C2 = C2_TX_COMPLETING; UART5_C2 = C2_TX_COMPLETING;
} else { } else {
if (++tail >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL6_TX_BUFFER_SIZE];
}
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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial6_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial6_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE;
}
}


#endif // HAS_KINETISK_UART5 #endif // HAS_KINETISK_UART5

+ 69
- 17
teensy3/serial6_lpuart.c View File



static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE]; static volatile BUFTYPE tx_buffer[SERIAL6_TX_BUFFER_SIZE];
static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE]; static volatile BUFTYPE rx_buffer[SERIAL6_RX_BUFFER_SIZE];
static volatile BUFTYPE *rx_buffer_storage_ = NULL;
static volatile BUFTYPE *tx_buffer_storage_ = NULL;

static size_t tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE;
static size_t rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE;
static size_t rts_low_watermark_ = RTS_LOW_WATERMARK;
static size_t rts_high_watermark_ = RTS_HIGH_WATERMARK;

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
if (transmit_pin) transmit_assert(); if (transmit_pin) transmit_assert();


head = tx_buffer_head; head = tx_buffer_head;
if (++head >= SERIAL6_TX_BUFFER_SIZE) head = 0;
if (++head >= tx_buffer_total_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 >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL6_TX_BUFFER_SIZE];
}
//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;
tx_buffer_tail = tail; tx_buffer_tail = tail;


head = tx_buffer_head; head = tx_buffer_head;
tail = tx_buffer_tail; tail = tx_buffer_tail;
if (head >= tail) return SERIAL6_TX_BUFFER_SIZE - 1 - head + tail;
if (head >= tail) return tx_buffer_total_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 SERIAL6_RX_BUFFER_SIZE + head - tail;
return rx_buffer_total_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 >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
c = rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_RX_BUFFER_SIZE) {
c = rx_buffer[tail];
} else {
c = rx_buffer_storage_[tail-SERIAL6_RX_BUFFER_SIZE];
}
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 = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail <= RTS_LOW_WATERMARK) rts_assert();
else avail = rx_buffer_total_size_ + head - tail;
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 >= SERIAL6_RX_BUFFER_SIZE) tail = 0;
return rx_buffer[tail];
if (++tail >= rx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_RX_BUFFER_SIZE) {
return rx_buffer[tail];
}
return rx_buffer_storage_[tail-SERIAL6_RX_BUFFER_SIZE];
} }


void serial6_clear(void) void serial6_clear(void)
// } // }
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 >= SERIAL6_RX_BUFFER_SIZE) head = 0;
if (head >= rx_buffer_total_size_) head = 0;
if (head != rx_buffer_tail) { if (head != rx_buffer_tail) {
rx_buffer[head] = n;
if (head < SERIAL6_RX_BUFFER_SIZE) {
rx_buffer[head] = n;
} else {
rx_buffer_storage_[head-SERIAL6_RX_BUFFER_SIZE] = n;
}

rx_buffer_head = head; rx_buffer_head = head;
} }
if (rts_pin) { if (rts_pin) {
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 = SERIAL6_RX_BUFFER_SIZE + head - tail;
if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
else avail = rx_buffer_total_size_ + head - tail;
if (avail >= rts_high_watermark_) rts_deassert();
} }
} }
c = LPUART0_CTRL; c = LPUART0_CTRL;
//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 >= SERIAL6_TX_BUFFER_SIZE) tail = 0;
n = tx_buffer[tail];
if (++tail >= tx_buffer_total_size_) tail = 0;
if (tail < SERIAL6_TX_BUFFER_SIZE) {
n = tx_buffer[tail];
} else {
n = tx_buffer_storage_[tail-SERIAL6_TX_BUFFER_SIZE];
}
//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;
tx_buffer_tail = tail; tx_buffer_tail = tail;
} }
} }


void serial6_add_memory_for_read(void *buffer, size_t length)
{
rx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE + length;
} else {
rx_buffer_total_size_ = SERIAL6_RX_BUFFER_SIZE;
}

rts_low_watermark_ = RTS_LOW_WATERMARK + length;
rts_high_watermark_ = RTS_HIGH_WATERMARK + length;
}

void serial6_add_memory_for_write(void *buffer, size_t length)
{
tx_buffer_storage_ = (BUFTYPE*)buffer;
if (buffer) {
tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE + length;
} else {
tx_buffer_total_size_ = SERIAL6_TX_BUFFER_SIZE;
}
}


#endif // HAS_KINETISK_LPUART0 #endif // HAS_KINETISK_LPUART0

+ 3
- 0
teensy4/HardwareSerial.cpp View File





void HardwareSerial::addToSerialEventsList() { void HardwareSerial::addToSerialEventsList() {
for (uint8_t i = 0; i < s_count_serials_with_serial_events; i++) {
if (s_serials_with_serial_events[i] == this) return; // already in the list.
}
s_serials_with_serial_events[s_count_serials_with_serial_events++] = this; s_serials_with_serial_events[s_count_serials_with_serial_events++] = this;
yield_active_check_flags |= YIELD_CHECK_HARDWARE_SERIAL; yield_active_check_flags |= YIELD_CHECK_HARDWARE_SERIAL;
} }

Loading…
Cancel
Save