1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
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
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
|
#include <errno.h>
#include <termios.h>
#include <unistd.h>
#include <fcntl.h>
#include <string.h> /* memset */
#include <stdio.h>
#include <stropts.h>
#include "../Include/serial.h"
#define MAXPORTS 5
static int fd;
int set_interface_attribs (int fd, int speed, int parity)
{
struct termios tty;
memset (&tty, 0, sizeof(tty));
if (tcgetattr (fd, &tty) != 0)
{
return -1;
}
int posix_baudrate=0;
switch(speed) {
case 115200: posix_baudrate = B115200; break;
//default: return -1;
}
cfsetospeed (&tty, posix_baudrate);
cfsetispeed (&tty, posix_baudrate);
tty.c_cflag = (tty.c_cflag & ~CSIZE) | CS8; // 8-bit chars
// disable IGNBRK for mismatched speed tests; otherwise receive break
// as \000 chars
tty.c_iflag &= ~IGNBRK; // disable break processing
tty.c_lflag = 0; // no signaling chars, no echo,
// no canonical processing
tty.c_oflag = 0; // no remapping, no delays
tty.c_cc[VMIN] = 0; // read doesn't block
tty.c_cc[VTIME] = 5; // 0.5 seconds read timeout
tty.c_iflag &= ~(IXON | IXOFF | IXANY); // shut off xon/xoff ctrl
tty.c_cflag |= (CLOCAL | CREAD);// ignore modem controls,
// enable reading
tty.c_cflag &= ~(PARENB | PARODD); // shut off parity
tty.c_cflag |= parity;
tty.c_cflag &= ~CSTOPB;
tty.c_cflag &= ~CRTSCTS;
if (tcsetattr (fd, TCSANOW, &tty) != 0)
{
return -1;
}
return 0;
}
void set_blocking (int b, int should_block)
{
struct termios tty;
memset (&tty, 0, sizeof tty);
if (tcgetattr (b, &tty) != 0)
{
return;
}
tty.c_cc[VMIN] = should_block ? 1 : 0;
tty.c_cc[VTIME] = 5; // 0.5 seconds read timeout
//if (tcsetattr (fd, TCSANOW, &tty) != 0)
// error_message ("error %d setting term attributes", errno);
}
int open_serial(int handle,int port, int baudrate){
char* portname;
//printf("%d\n",port);
int OK;
switch(port){
case 0: portname = "//dev/ttyACM0";break;
case 1: portname = "//dev/ttyACM1";break;
case 2: portname = "//dev/ttyACM2";break;
case 3: portname = "//dev/ttyACM3";break;
case 4: portname = "//dev/ttyACM4";break;
case 5: portname = "//dev/ttyACM5";break;
case 6: portname = "//dev/ttyACM6";break;
case 7: portname = "//dev/ttyACM7";break;
//default : return 2;
}
OK = 0;
//printf("%s\n",portname);
fd = open (portname, O_RDWR | O_NOCTTY | O_SYNC);
//fd = open (portname, O_RDWR | O_NOCTTY); //srikant
//printf("%d\n",fd);
if (fd < 0)
{
OK=2;
return OK;
}
set_interface_attribs (fd, baudrate, 0);
set_blocking (fd, 0); // set no blocking
//printf("Program running with status : %d\n",OK);
return OK;
}
int close_serial(int handle){
//usleep(1000);
close(fd);
//printf("Program closing....\n");
return 0;
}
int write_serial(int handle, char str[],int size){
if(write(fd, str, size)!=-1)
{
//printf("serial write started.\n");
//printf("%s\n",str );
//printf("%d\n",(int)str[0] );
}
usleep(size*100);
return 0;
}
int status_serial(int handle,int nb[]){
nb[0] = 2;
nb[1] = 2;
int OK=0;
//printf("Getting status.....\n");
return OK;
}
int read_serial(int handle,char buf[],int size){
char readbuf[size+1];
//int fl=tcflush(fd,TCOFLUSH);
//int fl=ioctl(fd,I_FLUSH,FLUSHW);
if(read(fd, readbuf, size)!=-1)
{
readbuf[size]='\0';
int i;
for (i = 0; i < size; ++i)
{
buf[i]=(readbuf[i]);
//printf("%u\n",buf[i] );
}
buf[size]='\0';
//printf("Reading has commenced..\n");
//printf("%d\n",(int)strlen(readbuf));
//printf("%s\n",readbuf);
return 0;
}
else
return 2 ;
}
/*void read_serial(int *handle,char buf[],int *size){
read(fd, buf, *size);
printf("Reading has commenced..\n");
}*/
|
