e67465cf4ede4ab8a6d867412c2da2c340160a48
[sim/e2-interface.git] / e2sim / previous / e2apv1sim / ricsim / test / Pendulum / Serial / adruino_serial.c
1 /*
2  *
3  * Copyright 2019 AT&T Intellectual Property
4  * Copyright 2019 Nokia
5  *
6  * Licensed under the Apache License, Version 2.0 (the "License");
7  * you may not use this file except in compliance with the License.
8  * You may obtain a copy of the License at
9  *
10  *      http://www.apache.org/licenses/LICENSE-2.0
11  *
12  * Unless required by applicable law or agreed to in writing, software
13  * distributed under the License is distributed on an "AS IS" BASIS,
14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15  * See the License for the specific language governing permissions and
16  * limitations under the License.
17  *
18  */
19
20 #include "stdio.h"
21 #include <string.h>
22 #include <unistd.h>
23
24 #include "adruino_serial.h"
25
26 int start_serial_inferface(int baudrate, char *serial_port)
27 {
28   int fd = -1;
29
30   fd = serialport_init(serial_port, baudrate);
31   if(fd == -1) {
32     fprintf(stderr, "couldn't open serial port %s\n", serial_port);
33     return -1;
34   } else {
35     fprintf(stderr, "Openning serial port: %s ...\n", serial_port);
36   }
37
38   serialport_flush(fd); // take 2 seconds
39   fprintf(stderr, "Serial port ready!\n");
40
41   return fd;
42
43 }
44
45 int serial_readline(int fd, char* buf, int buf_max)
46 {
47   if( fd == -1 ){
48     perror("serial port not opened");
49     return -1;
50   }
51
52   memset(buf, 0, buf_max);
53
54   do {
55      serialport_read_until(fd, buf, SERIAL_EOL_CHAR, buf_max, SERIAL_TIMEOUT);
56   } while( buf[0] == '\n' );
57
58   // serialport_read_until(fd, buf, SERIAL_EOL_CHAR, buf_max, SERIAL_TIMEOUT);
59
60   return 0;
61 }
62
63 int serial_writeline(int fd, char* buf)
64 {
65   if(buf[strlen(buf)-1] != SERIAL_EOL_CHAR){
66     //append EOL to buf
67     int len = strlen(buf);
68     buf[len] = SERIAL_EOL_CHAR;
69     buf[len+1] = '\0';
70   }
71
72   serialport_write(fd, buf);
73
74   return 0;
75 }
76
77 //For testing only
78 void test_adruino_serial(void)
79 {
80   int   fd;
81   char  buf[MAX_SERIAL_BUFFER];
82
83   fd = start_serial_inferface(DEFAULT_BAUDRATE, DEFAULT_SERIAL_PORT);
84
85   while(1){
86     fprintf(stderr, "[E2 Agent]: ");
87     fgets(buf, MAX_SERIAL_BUFFER, stdin);
88
89     // serialport_write(fd, "hello\n");
90     //serialport_write(fd, buf);
91     serial_writeline(fd, buf);
92
93     serial_readline(fd, buf, MAX_SERIAL_BUFFER);
94     fprintf(stderr, "[Adruino] %s", buf);
95   }
96
97   return;
98 }