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
157
158
|
#include "config.h"
#include <unistd.h>
#include <string.h>
#include <fcntl.h>
#include <errno.h>
#include <ctype.h>
#if defined(HAVE_SYS_MODEM_H)
#include <sys/modem.h>
#endif /* HAVE_SYS_MODEM_H */
#include "gpsd.h"
/* Workaround for HP-UX 11.23, which is missing CRTSCTS */
#ifndef CRTSCTS
# ifdef CNEW_RTSCTS
# define CRTSCTS CNEW_RTSCTS
# else
# define CRTSCTS 0
# endif /* CNEW_RTSCTS */
#endif /* !CRTSCTS */
int gpsd_get_speed(struct termios* ttyctl)
{
int code = cfgetospeed(ttyctl);
switch (code) {
case B0: return(0);
case B300: return(300);
case B1200: return(1200);
case B2400: return(2400);
case B4800: return(4800);
case B9600: return(9600);
case B19200: return(19200);
case B38400: return(38400);
default: return(57600);
}
}
int gpsd_set_speed(struct gps_session_t *session,
unsigned int speed, unsigned int stopbits)
{
unsigned int rate;
if (speed < 300)
rate = 0;
else if (speed < 1200)
rate = B300;
else if (speed < 2400)
rate = B1200;
else if (speed < 4800)
rate = B2400;
else if (speed < 9600)
rate = B4800;
else if (speed < 19200)
rate = B9600;
else if (speed < 38400)
rate = B19200;
else if (speed < 57600)
rate = B38400;
else
rate = B57600;
tcflush(session->gNMEAdata.gps_fd, TCIOFLUSH); /* toss stale data */
if (speed!=cfgetispeed(&session->ttyset) || stopbits!=session->gNMEAdata.stopbits) {
cfsetispeed(&session->ttyset, (speed_t)rate);
cfsetospeed(&session->ttyset, (speed_t)rate);
session->ttyset.c_cflag &=~ CSIZE;
session->ttyset.c_cflag |= (CSIZE & (stopbits==2 ? CS7 : CS8));
if (tcsetattr(session->gNMEAdata.gps_fd, TCSANOW, &session->ttyset) != 0)
return 0;
tcflush(session->gNMEAdata.gps_fd, TCIOFLUSH);
}
if ((session->packet_type = packet_sniff(session)) == BAD_PACKET)
return 0;
if (session->packet_type == SIRF_PACKET)
gpsd_switch_driver(session, "SIRF-II binary");
session->gNMEAdata.stopbits = stopbits;
session->gNMEAdata.baudrate = speed;
return 1;
}
int gpsd_open(struct gps_session_t *session)
{
unsigned int *ip;
unsigned int stopbits;
/* every rate we're likely to see on a GPS */
static unsigned int rates[] = {4800, 9600, 19200, 38400, 57600};
gpsd_report(1, "opening GPS data source at %s\n", session->gpsd_device);
if ((session->gNMEAdata.gps_fd = open(session->gpsd_device, O_RDWR|O_NOCTTY|O_SYNC)) < 0) {
gpsd_report(1, "device open failed: %s\n", strerror(errno));
return -1;
}
if (isatty(session->gNMEAdata.gps_fd)) {
#if NON_NMEA_ENABLE
struct gps_type_t **dp;
for (dp = gpsd_drivers; *dp; dp++)
if ((*dp)->probe && (*dp)->probe(session)) {
gpsd_report(3, "Probe found %s driver...\n", (*dp)->typename);
session->device_type = *dp;
return session->gNMEAdata.gps_fd;
}
#endif /* NON_NMEA_ENABLE */
/* Save original terminal parameters */
if (tcgetattr(session->gNMEAdata.gps_fd,&session->ttyset_old) != 0)
return -1;
memcpy(&session->ttyset,&session->ttyset_old,sizeof(session->ttyset));
/*
* Tip from Chris Kuethe: the FIDI chip used in the Trip-Nav
* 200 (and possibly other USB GPSes) gets completely hosed
* in the presence of flow control. Thus, turn off CRTSCTS.
*/
session->ttyset.c_cflag &= ~(PARENB | CRTSCTS);
session->ttyset.c_cflag |= CREAD | CLOCAL;
session->ttyset.c_iflag = session->ttyset.c_oflag = session->ttyset.c_lflag = (tcflag_t) 0;
session->ttyset.c_oflag = (ONLCR);
if (session->gNMEAdata.baudrate) {
gpsd_report(1, "setting speed %d, %d stopbits, no parity\n",
session->gNMEAdata.baudrate,
session->gNMEAdata.stopbits);
if (gpsd_set_speed(session, session->gNMEAdata.baudrate, session->gNMEAdata.stopbits)) {
return session->gNMEAdata.gps_fd;
}
}
for (stopbits = 1; stopbits <= 2; stopbits++)
for (ip = rates; ip < rates + sizeof(rates)/sizeof(rates[0]); ip++)
if (*ip != session->gNMEAdata.baudrate || stopbits != session->gNMEAdata.stopbits) {
gpsd_report(1,
"hunting at speed %d, %dN%d\n",
*ip, 9-stopbits, stopbits);
if (gpsd_set_speed(session, *ip, stopbits))
return session->gNMEAdata.gps_fd;
}
session->gNMEAdata.gps_fd = -1;
}
return session->gNMEAdata.gps_fd;
}
void gpsd_close(struct gps_session_t *session)
{
if (session->gNMEAdata.gps_fd != -1) {
if (isatty(session->gNMEAdata.gps_fd)) {
/* force hangup on close on systems that don't do HUPCL properly */
cfsetispeed(&session->ttyset, (speed_t)B0);
cfsetospeed(&session->ttyset, (speed_t)B0);
tcsetattr(session->gNMEAdata.gps_fd, TCSANOW, &session->ttyset);
}
/* this is the clean way to do it */
session->ttyset_old.c_cflag |= HUPCL;
tcsetattr(session->gNMEAdata.gps_fd,TCSANOW,&session->ttyset_old);
close(session->gNMEAdata.gps_fd);
}
}
|
