po_hi_driver_linux_serial.c 4.21 KB
Newer Older
1
2
3
4
5
6
7
8
/*
 * This is a part of PolyORB-HI-C distribution, a minimal
 * middleware written for generated code from AADL models.
 * You should use it with the Ocarina toolsuite.
 *
 * Copyright (C) 2010, European Space Agency
 */

9
10
#include <drivers/po_hi_driver_linux_serial.h>

11
#ifdef __PO_HI_NEED_DRIVER_SERIAL_LINUX
12

13
#define __PO_HI_DRIVER_SERIAL_LINUX_DEVICE "/dev/ttyS0"
14
#define __PO_HI_DRIVER_SERIAL_LINUX_BAUDRATE B19200
15
16

#include <po_hi_debug.h>
17
18
#include <po_hi_messages.h>
#include <po_hi_transport.h>
19
20
/* po-hi-c related files */

21
22
23
24
25
#include <activity.h>
#include <marshallers.h>
#include <deployment.h>
/* generated files */

26
27
28
29
#include <termios.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
30
#include <unistd.h>
31
32
33
34
#include <strings.h>
/* Linux-specific files */

int po_hi_c_driver_serial_fd;
35

36
37
void __po_hi_c_driver_serial_linux_poller (void)
{
38

39
40
   __po_hi_msg_t msg;
   __po_hi_request_t request;
41
   int n;
42
   __DEBUGMSG ("Hello, i'm the serial linux poller !\n");
43
   n = read (po_hi_c_driver_serial_fd, &msg, __PO_HI_MESSAGES_MAX_SIZE); 
44
   __DEBUGMSG ("[LINUX SERIAL] read() returns %d\n", n);
45
   msg.length = n;
46
47
   if (n > 0)
   {
48
49
50
51
      printf ("[LINUX SERIAL] Received: %s\n", msg.content);

      __po_hi_unmarshall_request (&request, &msg);
      __po_hi_main_deliver (&request);
52
   }
53
54
55
56
57
}


void __po_hi_c_driver_serial_linux_init (void)
{
58
59
60
61
   struct termios oldtio,newtio;

   __DEBUGMSG ("[LINUX SERIAL] Init\n");

62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
   po_hi_c_driver_serial_fd = open(__PO_HI_DRIVER_SERIAL_LINUX_DEVICE, O_RDWR | O_NOCTTY | O_NONBLOCK);

   if (po_hi_c_driver_serial_fd < 0)
   {
      __DEBUGMSG ("[LINUX SERIAL] Error while opening device %s\n", __PO_HI_DRIVER_SERIAL_LINUX_DEVICE);
   }

   tcgetattr (po_hi_c_driver_serial_fd, &oldtio);  /* save current serial port settings */
   bzero (&newtio, sizeof(newtio));                /* clear struct for new port settings */
        
   /* 
    * BAUDRATE: Set bps rate. You could also use cfsetispeed and cfsetospeed.
    * CRTSCTS : output hardware flow control (only used if the cable has
    *           all necessary lines. See sect. 7 of Serial-HOWTO)
    * CS8     : 8n1 (8bit,no parity,1 stopbit)
    * CLOCAL  : local connection, no modem contol
    * CREAD   : enable receiving characters
    */

   newtio.c_cflag = __PO_HI_DRIVER_SERIAL_LINUX_BAUDRATE | CRTSCTS | CS8 | CLOCAL | CREAD;
         
   /*
    *  IGNPAR  : ignore bytes with parity errors
    *  ICRNL   : map CR to NL (otherwise a CR input on the other computer
    *            will not terminate input) otherwise make device raw 
    *            (no other input processing)
    */
   newtio.c_iflag = IGNPAR | ICRNL;
         
   /*
    * Raw output.
    */
   newtio.c_oflag = 0;
         
   /*
    * ICANON  : enable canonical input
    * disable all echo functionality, and don't send signals to calling program
    */
   newtio.c_lflag = ICANON;

   /* 
    * Initialize all control characters 
    * default values can be found in /usr/include/termios.h, and are given
    * in the comments, but we don't need them here.
    */
   newtio.c_cc[VINTR]    = 0;     /* Ctrl-c */ 
   newtio.c_cc[VQUIT]    = 0;     /* Ctrl-\ */
   newtio.c_cc[VERASE]   = 0;     /* del */
   newtio.c_cc[VKILL]    = 0;     /* @ */
   newtio.c_cc[VEOF]     = 4;     /* Ctrl-d */
   newtio.c_cc[VTIME]    = 0;     /* inter-character timer unused */
   newtio.c_cc[VMIN]     = 1;     /* blocking read until 1 character arrives */
   newtio.c_cc[VSWTC]    = 0;     /* '\0' */
   newtio.c_cc[VSTART]   = 0;     /* Ctrl-q */ 
   newtio.c_cc[VSTOP]    = 0;     /* Ctrl-s */
   newtio.c_cc[VSUSP]    = 0;     /* Ctrl-z */
   newtio.c_cc[VEOL]     = 0;     /* '\0' */
   newtio.c_cc[VREPRINT] = 0;     /* Ctrl-r */
   newtio.c_cc[VDISCARD] = 0;     /* Ctrl-u */
   newtio.c_cc[VWERASE]  = 0;     /* Ctrl-w */
   newtio.c_cc[VLNEXT]   = 0;     /* Ctrl-v */
   newtio.c_cc[VEOL2]    = 0;     /* '\0' */

   /* 
    * clean the serial line and activate the settings for the port
    */
   tcflush (po_hi_c_driver_serial_fd, TCIFLUSH);
   tcsetattr (po_hi_c_driver_serial_fd, TCSANOW, &newtio);

    __DEBUGMSG ("[LINUX SERIAL] End of init\n");
132
133
134
135
}

int  __po_hi_c_driver_serial_linux_sender (__po_hi_task_id task, __po_hi_port_t port)
{
136
   write (po_hi_c_driver_serial_fd, "LINUX\n", 6);
137
   return 1;
138
139
}

140
141
#endif