From bd769039519285af6d5a5fe999819b4c66020dda Mon Sep 17 00:00:00 2001
From: batt <batt@38d2e660-2303-0410-9eaa-f027e97ec537>
Date: Fri, 2 Dec 2011 08:58:03 +0000
Subject: [PATCH] Signed-off by Robin Gilham: Patch to the posix_ser driver
 that reads input from the serial port and also sets the baudrate

git-svn-id: https://src.develer.com/svnoss/bertos/trunk@5176 38d2e660-2303-0410-9eaa-f027e97ec537
---
 bertos/emul/ser_posix.c | 116 +++++++++++++++++++++++++++++++++++++---
 1 file changed, 110 insertions(+), 6 deletions(-)

diff --git a/bertos/emul/ser_posix.c b/bertos/emul/ser_posix.c
index 50754b87..0b5a97fc 100644
--- a/bertos/emul/ser_posix.c
+++ b/bertos/emul/ser_posix.c
@@ -33,6 +33,8 @@
  * \brief Serial port emulator for hosted environments.
  *
  * \author Bernie Innocenti <bernie@codewiz.org>
+ *
+ * Updated by Robin Gilham to include reading from serial port and setting port speed <Robin@inventech.co.za>
  */
 
 #include "cfg/cfg_ser.h"
@@ -42,6 +44,8 @@
 
 #include <drv/ser.h>
 #include <drv/ser_p.h>
+#include <drv/timer.h>
+#include <cpu/power.h>
 
 #include <struct/fifobuf.h>
 
@@ -50,6 +54,11 @@
 
 #include <fcntl.h> /* open() */
 #include <unistd.h> /* read(), write() */
+#include <stdlib.h>
+#include <termios.h>
+
+static unsigned long BaudRate[] = {300,600,1200,1800,2400,4800,9600,19200,38400,57600,115200};
+static unsigned long BaudSetting[] = {B300,B600,B1200,B1800,B2400,B4800,B9600,B19200,B38400,B57600,B115200};
 
 
 /* From the high-level serial driver */
@@ -60,6 +69,24 @@ static unsigned char uart0_txbuffer[CONFIG_UART0_TXBUFSIZE];
 static unsigned char uart0_rxbuffer[CONFIG_UART0_RXBUFSIZE];
 static unsigned char uart1_txbuffer[CONFIG_UART1_TXBUFSIZE];
 static unsigned char uart1_rxbuffer[CONFIG_UART1_RXBUFSIZE];
+static unsigned char uart2_txbuffer[CONFIG_UART2_TXBUFSIZE];
+static unsigned char uart2_rxbuffer[CONFIG_UART2_RXBUFSIZE];
+
+
+//Change these to map to the Serial port I use USB connected serial ports
+static char* devFile[SER_CNT] = {
+		"/dev/ttyS0",
+		"/dev/ttyUSB0",
+		"/dev/ttyUSB1"
+};
+
+//Make this big enough not criticul as it is running in emulated enviroment
+#define SERIAL_RX_STACK_SIZE (KERN_MINSTACKSIZE*3)
+PROC_DEFINE_STACK(serial_rx_stack0, SERIAL_RX_STACK_SIZE);
+PROC_DEFINE_STACK(serial_rx_stack1, SERIAL_RX_STACK_SIZE);
+PROC_DEFINE_STACK(serial_rx_stack2, SERIAL_RX_STACK_SIZE);
+
+cpu_stack_t *serail_rx_stack[] = {serial_rx_stack0,serial_rx_stack1,serial_rx_stack2};
 
 
 /**
@@ -70,8 +97,13 @@ struct EmulSerial
 	struct SerialHardware hw;
 	struct Serial *ser;
 	int fd;
+	Process *ser_rcv_proc;
 };
 
+static void poll_serial_rcv(void);
+
+static struct termios oldtio,newtio;
+
 
 /*
  * Callbacks
@@ -79,15 +111,22 @@ struct EmulSerial
 static void uart_init(struct SerialHardware *_hw, struct Serial *ser)
 {
 	struct EmulSerial *hw = (struct EmulSerial *)_hw;
-
+	TRACEMSG("uart_init %d\n",ser->unit);
 	hw->ser = ser;
-	hw->fd = open("/dev/ttyS0", O_RDWR);
+	hw->fd = open(devFile[ser->unit], O_RDWR | O_NOCTTY | O_NDELAY);
+	ASSERT(hw->fd);
+    /* Make the file descriptor asynchronous (the manual page says only
+       O_APPEND and O_NONBLOCK, will work with F_SETFL...) */
+	fcntl(hw->fd, F_SETFL, FNDELAY);
+	tcflush(hw->fd, TCIFLUSH);
+	tcgetattr(hw->fd,&oldtio); /* save current port settings */
+	hw->ser_rcv_proc = proc_new(poll_serial_rcv,hw,SERIAL_RX_STACK_SIZE,serail_rx_stack[ser->unit]);
 }
 
 static void uart_cleanup(UNUSED_ARG(struct SerialHardware *, _hw))
 {
 	struct EmulSerial *hw = (struct EmulSerial *)_hw;
-
+	tcsetattr(hw->fd,TCSANOW,&oldtio);
 	close(hw->fd);
 	hw->fd = -1;
 }
@@ -109,10 +148,33 @@ static bool uart_txSending(UNUSED_ARG(struct SerialHardware *, _hw))
 }
 
 
-static void uart_setBaudrate(UNUSED_ARG(struct SerialHardware *, _hw), unsigned long rate)
+static void uart_setBaudrate(struct SerialHardware * _hw, unsigned long rate)
 {
-	TRACEMSG("rate=%lu", rate);
-	// TODO
+	int i;
+	struct EmulSerial *hw = (struct EmulSerial *)_hw;
+	TRACEMSG("rate=%d", rate);
+	for (i=0;i<sizeof(BaudRate)/sizeof(unsigned long);i++)
+		if (BaudRate[i]==rate)
+			break;
+	if (i<sizeof(BaudRate)/sizeof(unsigned long))
+	{
+        bzero(&newtio, sizeof(newtio));
+        newtio.c_cflag = BaudSetting[i] | CS8 | CLOCAL | CREAD;
+        newtio.c_iflag = IGNPAR ;
+        newtio.c_oflag  &= ~OPOST;
+
+
+        /* set input mode (non-canonical, no echo,...) */
+        newtio.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
+
+        tcsetattr(hw->fd,TCSANOW,&newtio);
+	}
+	else
+	{
+		TRACEMSG("invalid rate %d", rate);
+		ASSERT(i<sizeof(BaudRate)/sizeof(unsigned long));
+	}
+
 
 }
 
@@ -169,6 +231,17 @@ static struct EmulSerial UARTDescs[SER_CNT] =
 		C99INIT(ser, NULL),
 		C99INIT(fd, -1),
 	},
+	{
+		C99INIT(hw, /**/) {
+			C99INIT(table, &uart_vtable),
+			C99INIT(txbuffer, uart2_txbuffer),
+			C99INIT(rxbuffer, uart2_rxbuffer),
+			C99INIT(txbuffer_size, sizeof(uart2_txbuffer)),
+			C99INIT(rxbuffer_size, sizeof(uart2_rxbuffer)),
+		},
+		C99INIT(ser, NULL),
+		C99INIT(fd, -1),
+	},
 };
 
 struct SerialHardware *ser_hw_getdesc(int unit)
@@ -176,3 +249,34 @@ struct SerialHardware *ser_hw_getdesc(int unit)
 	ASSERT(unit < SER_CNT);
 	return &UARTDescs[unit].hw;
 }
+static void poll_serial_rcv(void)
+{
+	int res;
+	int p;
+	struct EmulSerial *hw = (struct EmulSerial *)proc_currentUserData();
+	//TRACEMSG("poll_serial_rcv dev %d\n",hw->ser->unit);
+	for(;;)
+	{
+		while(!fifo_isfull(&hw->ser->rxfifo))
+		{
+
+			res = read(hw->fd,&p,1);
+			//TRACEMSG("rcv %c res %d\n",(unsigned char)p,res);
+			if (res>0)
+			{
+				//TRACEMSG("rcv %02x ",p);
+				//printf("rcv %02x ", (unsigned char)p);
+				fifo_push_locked(&hw->ser->rxfifo, (unsigned char)p);
+			}
+			else if (res==0)
+				//Delay for 2 ticks if no characters are read
+				timer_delay(2);
+			else
+				//exit if there is and error i.e. the port closes
+				goto exit_rcv;
+		}
+		cpu_relax();
+	}
+exit_rcv:
+	return;
+}
-- 
2.25.1