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

diff --git a/bertos/emul/ser_posix.c b/bertos/emul/ser_posix.c
index 50754b87927fdf885e26cf4262dbaaae6fa2b4fa..0b5a97fc560f095c58b95e54d627671a731538f5 100644 (file)
--- 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;
+}