mc1322x: build fixes for uart2
This commit is contained in:
parent
e2d74fa0a5
commit
e80f9eb4b5
8 changed files with 124 additions and 51 deletions
|
@ -28,7 +28,7 @@
|
|||
* SUCH DAMAGE.
|
||||
*
|
||||
* This file is part of libmc1322x: see http://mc1322x.devl.org
|
||||
* for details.
|
||||
* for details.
|
||||
*
|
||||
*
|
||||
*/
|
||||
|
@ -36,43 +36,91 @@
|
|||
#include <mc1322x.h>
|
||||
#include <stdint.h>
|
||||
|
||||
volatile char u2_tx_buf[64];
|
||||
volatile uint32_t u2_head, u2_tail;
|
||||
volatile char u2_tx_buf[UART2_TX_BUFFERSIZE];
|
||||
volatile uint32_t u2_tx_head, u2_tx_tail;
|
||||
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
volatile char u2_rx_buf[UART2_RX_BUFFERSIZE-32];
|
||||
volatile uint32_t u2_rx_head, u2_rx_tail;
|
||||
#endif
|
||||
|
||||
void uart2_isr(void) {
|
||||
while( *UART1_UTXCON != 0 ) {
|
||||
if (u2_head == u2_tail) {
|
||||
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
if (*UART2_USTAT & ( 1 << 6)) { //receive interrupt
|
||||
while( *UART2_URXCON != 0 ) { //flush the hardware fifo into the software buffer
|
||||
uint32_t u2_rx_tail_next;
|
||||
u2_rx_tail_next = u2_rx_tail+1;
|
||||
if (u2_rx_tail_next >= sizeof(u2_rx_buf))
|
||||
u2_rx_tail_next = 0;
|
||||
if (u2_rx_head != u2_rx_tail_next) {
|
||||
u2_rx_buf[u2_rx_tail]= *UART2_UDATA;
|
||||
u2_rx_tail = u2_rx_tail_next;
|
||||
}
|
||||
}
|
||||
return;
|
||||
}
|
||||
#endif
|
||||
|
||||
while( *UART2_UTXCON != 0 ) {
|
||||
if (u2_tx_head == u2_tx_tail) {
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
*UART2_UCON |= (1 << 13); /*disable tx interrupt */
|
||||
#else
|
||||
disable_irq(UART2);
|
||||
#endif
|
||||
return;
|
||||
}
|
||||
*UART2_UDATA = u2_tx_buf[u2_tail];
|
||||
u2_tail++;
|
||||
if (u2_tail >= sizeof(u2_tx_buf))
|
||||
u2_tail = 0;
|
||||
|
||||
*UART2_UDATA = u2_tx_buf[u2_tx_tail];
|
||||
u2_tx_tail++;
|
||||
if (u2_tx_tail >= sizeof(u2_tx_buf))
|
||||
u2_tx_tail = 0;
|
||||
}
|
||||
}
|
||||
|
||||
void uart2_putc(char c) {
|
||||
/* disable UART2 since */
|
||||
/* UART2 isr modifies u2_head and u2_tail */
|
||||
disable_irq(UART2);
|
||||
/* UART2 isr modifies u2_tx_head and u2_tx_tail */
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
*UART2_UCON |= (1 << 13); /*disable tx interrupt */
|
||||
#else
|
||||
disable_irq(UART2);
|
||||
#endif
|
||||
|
||||
if( (u2_head == u2_tail) &&
|
||||
if( (u2_tx_head == u2_tx_tail) &&
|
||||
(*UART2_UTXCON != 0)) {
|
||||
*UART2_UDATA = c;
|
||||
} else {
|
||||
u2_tx_buf[u2_head] = c;
|
||||
u2_head += 1;
|
||||
if (u2_head >= sizeof(u2_tx_buf))
|
||||
u2_head = 0;
|
||||
if (u2_head == u2_tail) { /* drop chars when no room */
|
||||
if (u2_head) { u2_head -=1; } else { u2_head = sizeof(u2_tx_buf); }
|
||||
u2_tx_buf[u2_tx_head] = c;
|
||||
u2_tx_head += 1;
|
||||
if (u2_tx_head >= sizeof(u2_tx_buf))
|
||||
u2_tx_head = 0;
|
||||
if (u2_tx_head == u2_tx_tail) { /* drop chars when no room */
|
||||
if (u2_tx_head) { u2_tx_head -=1; } else { u2_tx_head = sizeof(u2_tx_buf); }
|
||||
}
|
||||
enable_irq(UART1);
|
||||
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
*UART2_UCON &= ~(1 << 13); /*enable tx interrupt */
|
||||
#else
|
||||
enable_irq(UART2);
|
||||
#endif
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t uart2_getc(void) {
|
||||
#if UART2_RX_BUFFERSIZE > 32
|
||||
/* First pull from the ram buffer */
|
||||
uint8_t c=0;
|
||||
if (u2_rx_head != u2_rx_tail) {
|
||||
c = u2_rx_buf[u2_rx_head++];
|
||||
if (u2_rx_head >= sizeof(u2_rx_buf))
|
||||
u2_rx_head=0;
|
||||
return c;
|
||||
}
|
||||
#endif
|
||||
/* Then pull from the hardware fifo */
|
||||
while(uart2_can_get() == 0) { continue; }
|
||||
return *UART2_UDATA;
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue