X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fcc1111%2Fao_serial.c;fp=src%2Fcc1111%2Fao_serial.c;h=00c85ff3fa268e7b31caab8fa999a4f665c02cd5;hp=4d5b9abd5693c048e61c737944965c42d50bb17b;hb=040a6eb119451026e1ec7c3a6a8e76b439c632d5;hpb=f952f9c285e2718a433c8c720c9b5d9c369e7036

diff --git a/src/cc1111/ao_serial.c b/src/cc1111/ao_serial.c
index 4d5b9abd..00c85ff3 100644
--- a/src/cc1111/ao_serial.c
+++ b/src/cc1111/ao_serial.c
@@ -17,78 +17,168 @@
 
 #include "ao.h"
 
-volatile __xdata struct ao_fifo	ao_usart1_rx_fifo;
-volatile __xdata struct ao_fifo	ao_usart1_tx_fifo;
+#if HAS_SERIAL_0
+
+volatile __xdata struct ao_fifo	ao_serial0_rx_fifo;
+volatile __xdata struct ao_fifo	ao_serial0_tx_fifo;
+
+void
+ao_serial0_rx_isr(void) __interrupt 2
+{
+	if (!ao_fifo_full(ao_serial0_rx_fifo))
+		ao_fifo_insert(ao_serial0_rx_fifo, U0DBUF);
+	ao_wakeup(&ao_serial0_rx_fifo);
+#if USE_SERIAL_0_STDIN
+	ao_wakeup(&ao_stdin_ready);
+#endif
+}
+
+static __xdata uint8_t ao_serial0_tx_started;
+
+static void
+ao_serial0_tx_start(void)
+{
+	if (!ao_fifo_empty(ao_serial0_tx_fifo) &&
+	    !ao_serial0_tx_started)
+	{
+		ao_serial0_tx_started = 1;
+		ao_fifo_remove(ao_serial0_tx_fifo, U0DBUF);
+	}
+}
+
+void
+ao_serial0_tx_isr(void) __interrupt 7
+{
+	UTX0IF = 0;
+	ao_serial0_tx_started = 0;
+	ao_serial0_tx_start();
+	ao_wakeup(&ao_serial0_tx_fifo);
+}
+
+char
+ao_serial0_getchar(void) __critical
+{
+	char	c;
+	while (ao_fifo_empty(ao_serial0_rx_fifo))
+		ao_sleep(&ao_serial0_rx_fifo);
+	ao_fifo_remove(ao_serial0_rx_fifo, c);
+	return c;
+}
+
+#if USE_SERIAL_0_STDIN
+char
+ao_serial0_pollchar(void) __critical
+{
+	char	c;
+	if (ao_fifo_empty(ao_serial0_rx_fifo))
+		return AO_READ_AGAIN;
+	ao_fifo_remove(ao_serial0_rx_fifo,c);
+	return c;
+}
+#endif
+
+void
+ao_serial0_putchar(char c) __critical
+{
+	while (ao_fifo_full(ao_serial0_tx_fifo))
+		ao_sleep(&ao_serial0_tx_fifo);
+	ao_fifo_insert(ao_serial0_tx_fifo, c);
+	ao_serial0_tx_start();
+}
+
+void
+ao_serial0_drain(void) __critical
+{
+	while (!ao_fifo_empty(ao_serial0_tx_fifo))
+		ao_sleep(&ao_serial0_tx_fifo);
+}
+
+void
+ao_serial0_set_speed(uint8_t speed)
+{
+	ao_serial0_drain();
+	if (speed > AO_SERIAL_SPEED_57600)
+		return;
+	U0UCR |= UxUCR_FLUSH;
+	U0BAUD = ao_serial_speeds[speed].baud;
+	U0GCR = ao_serial_speeds[speed].gcr;
+}
+#endif /* HAS_SERIAL_0 */
+
+#if HAS_SERIAL_1
+
+volatile __xdata struct ao_fifo	ao_serial1_rx_fifo;
+volatile __xdata struct ao_fifo	ao_serial1_tx_fifo;
 
 void
-ao_serial_rx1_isr(void) __interrupt 3
+ao_serial1_rx_isr(void) __interrupt 3
 {
-	if (!ao_fifo_full(ao_usart1_rx_fifo))
-		ao_fifo_insert(ao_usart1_rx_fifo, U1DBUF);
-	ao_wakeup(&ao_usart1_rx_fifo);
-#if USE_SERIAL_STDIN
+	if (!ao_fifo_full(ao_serial1_rx_fifo))
+		ao_fifo_insert(ao_serial1_rx_fifo, U1DBUF);
+	ao_wakeup(&ao_serial1_rx_fifo);
+#if USE_SERIAL1_STDIN
 	ao_wakeup(&ao_stdin_ready);
 #endif
 }
 
-static __xdata uint8_t ao_serial_tx1_started;
+static __xdata uint8_t ao_serial1_tx_started;
 
 static void
-ao_serial_tx1_start(void)
+ao_serial1_tx_start(void)
 {
-	if (!ao_fifo_empty(ao_usart1_tx_fifo) &&
-	    !ao_serial_tx1_started)
+	if (!ao_fifo_empty(ao_serial1_tx_fifo) &&
+	    !ao_serial1_tx_started)
 	{
-		ao_serial_tx1_started = 1;
-		ao_fifo_remove(ao_usart1_tx_fifo, U1DBUF);
+		ao_serial1_tx_started = 1;
+		ao_fifo_remove(ao_serial1_tx_fifo, U1DBUF);
 	}
 }
 
 void
-ao_serial_tx1_isr(void) __interrupt 14
+ao_serial1_tx_isr(void) __interrupt 14
 {
 	UTX1IF = 0;
-	ao_serial_tx1_started = 0;
-	ao_serial_tx1_start();
-	ao_wakeup(&ao_usart1_tx_fifo);
+	ao_serial1_tx_started = 0;
+	ao_serial1_tx_start();
+	ao_wakeup(&ao_serial1_tx_fifo);
 }
 
 char
-ao_serial_getchar(void) __critical
+ao_serial1_getchar(void) __critical
 {
 	char	c;
-	while (ao_fifo_empty(ao_usart1_rx_fifo))
-		ao_sleep(&ao_usart1_rx_fifo);
-	ao_fifo_remove(ao_usart1_rx_fifo, c);
+	while (ao_fifo_empty(ao_serial1_rx_fifo))
+		ao_sleep(&ao_serial1_rx_fifo);
+	ao_fifo_remove(ao_serial1_rx_fifo, c);
 	return c;
 }
 
-#if USE_SERIAL_STDIN
+#if USE_SERIAL_1_STDIN
 char
-ao_serial_pollchar(void) __critical
+ao_serial1_pollchar(void) __critical
 {
 	char	c;
-	if (ao_fifo_empty(ao_usart1_rx_fifo))
+	if (ao_fifo_empty(ao_serial1_rx_fifo))
 		return AO_READ_AGAIN;
-	ao_fifo_remove(ao_usart1_rx_fifo,c);
+	ao_fifo_remove(ao_serial1_rx_fifo,c);
 	return c;
 }
 #endif
 
 void
-ao_serial_putchar(char c) __critical
+ao_serial1_putchar(char c) __critical
 {
-	while (ao_fifo_full(ao_usart1_tx_fifo))
-		ao_sleep(&ao_usart1_tx_fifo);
-	ao_fifo_insert(ao_usart1_tx_fifo, c);
-	ao_serial_tx1_start();
+	while (ao_fifo_full(ao_serial1_tx_fifo))
+		ao_sleep(&ao_serial1_tx_fifo);
+	ao_fifo_insert(ao_serial1_tx_fifo, c);
+	ao_serial1_tx_start();
 }
 
 void
-ao_serial_drain(void) __critical
+ao_serial1_drain(void) __critical
 {
-	while (!ao_fifo_empty(ao_usart1_tx_fifo))
-		ao_sleep(&ao_usart1_tx_fifo);
+	while (!ao_fifo_empty(ao_serial1_tx_fifo))
+		ao_sleep(&ao_serial1_tx_fifo);
 }
 
 const __code struct ao_serial_speed ao_serial_speeds[] = {
@@ -111,9 +201,9 @@ const __code struct ao_serial_speed ao_serial_speeds[] = {
 };
 
 void
-ao_serial_set_speed(uint8_t speed)
+ao_serial1_set_speed(uint8_t speed)
 {
-	ao_serial_drain();
+	ao_serial1_drain();
 	if (speed > AO_SERIAL_SPEED_57600)
 		return;
 	U1UCR |= UxUCR_FLUSH;
@@ -121,9 +211,67 @@ ao_serial_set_speed(uint8_t speed)
 	U1GCR = ao_serial_speeds[speed].gcr;
 }
 
+#endif /* HAS_SERIAL_1 */
+
 void
 ao_serial_init(void)
 {
+#if HAS_SERIAL_0
+#if HAS_SERIAL_0_ALT_1
+	/* Set up the USART pin assignment */
+	PERCFG = (PERCFG & ~PERCFG_U0CFG_ALT_MASK) | PERCFG_U0CFG_ALT_1;
+
+	P2DIR = (P2DIR & ~P2DIR_PRIP0_MASK) | P2DIR_PRIP0_USART0_USART1;
+
+	/* Make the USART pins be controlled by the USART */
+	P0SEL |= (1 << 2) | (1 << 3);
+#if HAS_SERIAL_0_HW_FLOW
+	P0SEL |= (1 << 4) | (1 << 5);
+#endif
+#else
+	/* Set up the USART pin assignment */
+	PERCFG = (PERCFG & ~PERCFG_U0CFG_ALT_MASK) | PERCFG_U0CFG_ALT_2;
+
+	P2SEL = (P2SEL & ~(P2SEL_PRI3P1_MASK | P2SEL_PRI0P1_MASK)) |
+		(P2SEL_PRI3P1_USART0 | P2SEL_PRI0P1_USART0);
+
+	/* Make the USART pins be controlled by the USART */
+	P1SEL |= (1 << 2) | (1 << 3);
+#if HAS_SERIAL_0_HW_FLOW
+	P1SEL |= (1 << 5) | (1 << 4);
+#endif
+#endif
+
+	/* UART mode with receiver enabled */
+	U0CSR = (UxCSR_MODE_UART | UxCSR_RE);
+
+	/* Pick a 9600 baud rate */
+	ao_serial0_set_speed(AO_SERIAL_SPEED_9600);
+
+	/* Reasonable serial parameters */
+	U0UCR = (UxUCR_FLUSH |
+#if HAS_SERIAL_0_HW_FLOW
+		 UxUCR_FLOW_ENABLE |
+#else
+		 UxUCR_FLOW_DISABLE |
+#endif
+		 UxUCR_D9_EVEN_PARITY |
+		 UxUCR_BIT9_8_BITS |
+		 UxUCR_PARITY_DISABLE |
+		 UxUCR_SPB_1_STOP_BIT |
+		 UxUCR_STOP_HIGH |
+		 UxUCR_START_LOW);
+
+	IEN0 |= IEN0_URX0IE;
+	IEN2 |= IEN2_UTX0IE;
+#if USE_SERIAL_0_STDIN && !DELAY_SERIAL_0_STDIN
+	ao_add_stdio(ao_serial0_pollchar,
+		     ao_serial0_putchar,
+		     NULL);
+#endif
+#endif /* HAS_SERIAL_0 */
+
+#if HAS_SERIAL_1
 #if HAS_SERIAL_1_ALT_1
 	/* Set up the USART pin assignment */
 	PERCFG = (PERCFG & ~PERCFG_U1CFG_ALT_MASK) | PERCFG_U1CFG_ALT_1;
@@ -151,7 +299,7 @@ ao_serial_init(void)
 	U1CSR = (UxCSR_MODE_UART | UxCSR_RE);
 
 	/* Pick a 4800 baud rate */
-	ao_serial_set_speed(AO_SERIAL_SPEED_4800);
+	ao_serial1_set_speed(AO_SERIAL_SPEED_4800);
 
 	/* Reasonable serial parameters */
 	U1UCR = (UxUCR_FLUSH |
@@ -169,4 +317,11 @@ ao_serial_init(void)
 
 	IEN0 |= IEN0_URX1IE;
 	IEN2 |= IEN2_UTX1IE;
+
+#if USE_SERIAL_1_STDIN && !DELAY_SERIAL_1_STDIN
+	ao_add_stdio(ao_serial1_pollchar,
+		     ao_serial1_putchar,
+		     NULL);
+#endif
+#endif /* HAS_SERIAL_1 */
 }