line |
stmt |
bran |
cond |
sub |
pod |
time |
code |
1
|
|
|
|
|
|
|
# Copyright (c) 1999-2000 João Pedro Gonçalves . All rights reserved. |
2
|
|
|
|
|
|
|
# This program is free software; you can redistribute it and/or |
3
|
|
|
|
|
|
|
# modify it under the same terms as Perl itself. |
4
|
|
|
|
|
|
|
|
5
|
|
|
|
|
|
|
package GPS::Serial; |
6
|
|
|
|
|
|
|
|
7
|
3
|
|
|
3
|
|
14
|
use strict; |
|
3
|
|
|
|
|
6
|
|
|
3
|
|
|
|
|
113
|
|
8
|
3
|
|
|
3
|
|
14
|
use vars qw($VERSION $OS_win $has_serialport $stty_path); |
|
3
|
|
|
|
|
5
|
|
|
3
|
|
|
|
|
549
|
|
9
|
|
|
|
|
|
|
|
10
|
|
|
|
|
|
|
$VERSION = sprintf("%d.%02d", q$Revision: 1.18 $ =~ /(\d+)\.(\d+)/); |
11
|
|
|
|
|
|
|
|
12
|
|
|
|
|
|
|
BEGIN { |
13
|
|
|
|
|
|
|
#Taken from SerialPort/eg/any_os.plx |
14
|
|
|
|
|
|
|
|
15
|
|
|
|
|
|
|
#We try to use Device::SerialPort or |
16
|
|
|
|
|
|
|
#Win32::SerialPort, if it's not windows |
17
|
|
|
|
|
|
|
#and there's no Device::SerialPort installed, |
18
|
|
|
|
|
|
|
#then we just use the FileHandle module that |
19
|
|
|
|
|
|
|
#comes with perl |
20
|
|
|
|
|
|
|
|
21
|
3
|
50
|
|
3
|
|
14
|
$OS_win = ($^O eq "MSWin32") ? 1 : 0; |
22
|
|
|
|
|
|
|
|
23
|
3
|
50
|
|
3
|
|
190
|
if ($OS_win) { |
|
3
|
50
|
|
|
|
3813
|
|
|
3
|
0
|
|
|
|
107523
|
|
|
3
|
0
|
|
|
|
135
|
|
24
|
0
|
|
|
|
|
0
|
eval "use Win32::SerialPort"; |
25
|
0
|
0
|
|
|
|
0
|
die "Must have Win32::SerialPort correctly installed: $@\n" if ($@); |
26
|
0
|
|
|
|
|
0
|
$has_serialport++; |
27
|
|
|
|
|
|
|
} elsif (eval q{ use Device::SerialPort; 1 }) { |
28
|
3
|
|
|
|
|
5069
|
$has_serialport++; |
29
|
|
|
|
|
|
|
} elsif (eval q{ use POSIX qw(:termios_h); use FileHandle; 1}) { |
30
|
|
|
|
|
|
|
# NOP |
31
|
|
|
|
|
|
|
} elsif (-x "/bin/stty") { |
32
|
0
|
|
|
|
|
0
|
$stty_path = "/bin/stty"; |
33
|
|
|
|
|
|
|
} else { |
34
|
0
|
|
|
|
|
0
|
die "Missing either POSIX, FileHandle, Device::SerialPort or /bin/stty"; |
35
|
|
|
|
|
|
|
} |
36
|
|
|
|
|
|
|
} # End BEGIN |
37
|
|
|
|
|
|
|
|
38
|
|
|
|
|
|
|
#$|++; # XXX should not be here... |
39
|
|
|
|
|
|
|
|
40
|
|
|
|
|
|
|
sub _read { |
41
|
|
|
|
|
|
|
#$self->_read(length) |
42
|
|
|
|
|
|
|
#reads packets from whatever you're listening from. |
43
|
|
|
|
|
|
|
#length defaults to 1 |
44
|
|
|
|
|
|
|
|
45
|
600
|
|
|
600
|
|
2860
|
my ($self,$len) = @_; |
46
|
600
|
|
50
|
|
|
3529
|
$len ||=1; |
47
|
|
|
|
|
|
|
|
48
|
600
|
50
|
|
|
|
1613
|
$self->serial or die "Read from an uninitialized handle"; |
49
|
|
|
|
|
|
|
|
50
|
600
|
|
|
|
|
1198
|
my $buf; |
51
|
|
|
|
|
|
|
|
52
|
600
|
50
|
|
|
|
1855
|
if ($self->{serialtype} eq 'FileHandle') { |
53
|
600
|
|
|
|
|
1637
|
sysread($self->serial,$buf,$len); |
54
|
|
|
|
|
|
|
} else { |
55
|
0
|
|
|
|
|
0
|
(undef, $buf) = $self->serial->read($len); |
56
|
|
|
|
|
|
|
} |
57
|
|
|
|
|
|
|
|
58
|
600
|
50
|
33
|
|
|
2878
|
if ($self->{verbose} && $buf) { |
59
|
0
|
|
|
|
|
0
|
print STDERR "R:(",join(" ", map {$self->Pid_Byte($_)}unpack("C*",$buf)),")\n"; |
|
0
|
|
|
|
|
0
|
|
60
|
|
|
|
|
|
|
} else { |
61
|
|
|
|
|
|
|
# Strange: this delay is necessary, otherwise nothing works |
62
|
|
|
|
|
|
|
# (seen on a slow Debian machine with Garmin Vista) |
63
|
|
|
|
|
|
|
# Turning on verbose output also helps |
64
|
600
|
|
|
|
|
1829
|
$self->usleep(1); |
65
|
|
|
|
|
|
|
} |
66
|
|
|
|
|
|
|
|
67
|
600
|
|
|
|
|
4092
|
return $buf; |
68
|
|
|
|
|
|
|
} |
69
|
|
|
|
|
|
|
|
70
|
|
|
|
|
|
|
sub _readline { |
71
|
|
|
|
|
|
|
#$self->_readline() |
72
|
|
|
|
|
|
|
#reads until $/ is found |
73
|
|
|
|
|
|
|
#NMEA-aware - only lines beginning with $ count |
74
|
|
|
|
|
|
|
#if NMEA is the chosen protocol |
75
|
|
|
|
|
|
|
|
76
|
14
|
|
|
14
|
|
29
|
my ($self) = @_; |
77
|
14
|
|
|
|
|
26
|
my $line = ''; |
78
|
14
|
50
|
|
|
|
38
|
$self->serial or warn "Read from an uninitialized handle"; |
79
|
|
|
|
|
|
|
|
80
|
14
|
|
|
0
|
|
364
|
local $SIG{ALRM} = sub {die "GPS Device has timed out\n"}; |
|
0
|
|
|
|
|
0
|
|
81
|
14
|
|
|
|
|
28
|
eval { alarm($self->{timeout}) }; |
|
14
|
|
|
|
|
89
|
|
82
|
|
|
|
|
|
|
|
83
|
14
|
|
|
|
|
25
|
while (1) { |
84
|
600
|
100
|
|
|
|
2180
|
$self->usleep(1) unless (length($line) % 32); |
85
|
600
|
|
|
|
|
1780
|
my $buf .= $self->_read; |
86
|
600
|
|
|
|
|
1491
|
$line .= $buf; |
87
|
600
|
100
|
|
|
|
3247
|
if ($buf eq $/) { |
88
|
14
|
|
|
|
|
81
|
eval {alarm(0) }; |
|
14
|
|
|
|
|
87
|
|
89
|
14
|
50
|
33
|
|
|
541
|
return ( ($self->{protocol} eq 'NMEA' && substr($line,0,1) ne '$') |
90
|
|
|
|
|
|
|
? $self->_readline |
91
|
|
|
|
|
|
|
: $line ); |
92
|
|
|
|
|
|
|
} |
93
|
586
|
|
|
|
|
1245
|
eval { alarm($self->{timeout}) }; # set new timeout |
|
586
|
|
|
|
|
8272
|
|
94
|
|
|
|
|
|
|
} |
95
|
|
|
|
|
|
|
} |
96
|
|
|
|
|
|
|
|
97
|
|
|
|
|
|
|
sub safe_read { |
98
|
|
|
|
|
|
|
#Reads one byte, escapes DLE bytes |
99
|
|
|
|
|
|
|
#Used by the GRMN Protocol |
100
|
0
|
|
|
0
|
0
|
0
|
my $self = shift; |
101
|
0
|
|
|
|
|
0
|
my $buf = $self->_read; |
102
|
0
|
0
|
|
|
|
0
|
$buf eq "\x10" ? $self->_read : $buf; |
103
|
|
|
|
|
|
|
} |
104
|
|
|
|
|
|
|
|
105
|
|
|
|
|
|
|
sub _write { |
106
|
|
|
|
|
|
|
#$self->_write(buffer,length) |
107
|
|
|
|
|
|
|
#syswrite wrapper for the serial device |
108
|
|
|
|
|
|
|
#length defaults to buffer length |
109
|
|
|
|
|
|
|
|
110
|
0
|
|
|
0
|
|
0
|
my ($self,$buf,$len,$offset) = @_; |
111
|
0
|
0
|
|
|
|
0
|
$self->connect() or die "Write to an uninitialized handle"; |
112
|
|
|
|
|
|
|
|
113
|
0
|
|
0
|
|
|
0
|
$len ||= length($buf); |
114
|
|
|
|
|
|
|
|
115
|
0
|
0
|
|
|
|
0
|
if ($self->{verbose}) { |
116
|
0
|
|
|
|
|
0
|
print STDERR "W:(",join(" ", map {$self->Pid_Byte($_)}unpack("C*",$buf)),")\n"; |
|
0
|
|
|
|
|
0
|
|
117
|
|
|
|
|
|
|
} |
118
|
|
|
|
|
|
|
|
119
|
0
|
0
|
|
|
|
0
|
$self->serial or die "Write to an uninitialized handle"; |
120
|
|
|
|
|
|
|
|
121
|
0
|
0
|
|
|
|
0
|
if ($self->{serialtype} eq 'FileHandle') { |
122
|
0
|
|
0
|
|
|
0
|
syswrite($self->serial,$buf,$len,$offset||0); |
123
|
|
|
|
|
|
|
} else { |
124
|
0
|
|
|
|
|
0
|
my $out_len = $self->serial->write($buf); |
125
|
0
|
0
|
|
|
|
0
|
warn "Write incomplete ($len != $out_len)\n" if ( $len != $out_len ); |
126
|
|
|
|
|
|
|
} |
127
|
|
|
|
|
|
|
} |
128
|
|
|
|
|
|
|
|
129
|
|
|
|
|
|
|
sub connect { |
130
|
1
|
|
|
1
|
0
|
3
|
my $self = shift; |
131
|
1
|
50
|
|
|
|
7
|
return $self->serial if $self->serial; |
132
|
|
|
|
|
|
|
|
133
|
1
|
50
|
33
|
|
|
10
|
if ($OS_win || $has_serialport) { |
|
|
0
|
|
|
|
|
|
134
|
1
|
|
|
|
|
7
|
$self->{serial} = $self->serialport_connect; |
135
|
|
|
|
|
|
|
} elsif (defined $stty_path) { |
136
|
0
|
|
|
|
|
0
|
$self->{serial} = $self->stty_connect; |
137
|
|
|
|
|
|
|
} else { |
138
|
0
|
|
|
|
|
0
|
$self->{serial} = $self->unix_connect; |
139
|
|
|
|
|
|
|
} |
140
|
|
|
|
|
|
|
|
141
|
0
|
0
|
|
|
|
0
|
print "Using $$self{serialtype}\n" if $self->verbose; |
142
|
|
|
|
|
|
|
} |
143
|
|
|
|
|
|
|
|
144
|
|
|
|
|
|
|
sub serialport_connect { |
145
|
1
|
|
|
1
|
0
|
3
|
my $self= shift; |
146
|
1
|
|
50
|
|
|
12
|
my $PortObj = ( $OS_win ? |
147
|
|
|
|
|
|
|
(new Win32::SerialPort ($self->{port})) : |
148
|
|
|
|
|
|
|
(new Device::SerialPort ($self->{port})) ) |
149
|
|
|
|
|
|
|
|| die "Can't open $$self{port}: $!\n"; |
150
|
|
|
|
|
|
|
|
151
|
0
|
|
|
|
|
0
|
$PortObj->baudrate($self->{baud}); |
152
|
0
|
|
|
|
|
0
|
$PortObj->parity("none"); |
153
|
0
|
|
|
|
|
0
|
$PortObj->databits(8); |
154
|
0
|
|
|
|
|
0
|
$PortObj->stopbits(1); |
155
|
0
|
0
|
|
|
|
0
|
$PortObj->read_interval(5) if $OS_win; |
156
|
0
|
|
|
|
|
0
|
$PortObj->write_settings; |
157
|
0
|
|
|
|
|
0
|
$self->{serialtype} = 'SerialPort'; |
158
|
0
|
|
|
|
|
0
|
$PortObj; |
159
|
|
|
|
|
|
|
} |
160
|
|
|
|
|
|
|
|
161
|
|
|
|
|
|
|
sub unix_connect { |
162
|
|
|
|
|
|
|
#This was adapted from a script on connecting to a sony DSS, credits to its author (lost his email) |
163
|
0
|
|
|
0
|
0
|
0
|
my $self = shift; |
164
|
0
|
|
|
|
|
0
|
my $port = $self->{'port'}; |
165
|
0
|
|
|
|
|
0
|
my $baud = $self->{'baud'}; |
166
|
0
|
|
|
|
|
0
|
my($termios,$cflag,$lflag,$iflag,$oflag,$voice); |
167
|
|
|
|
|
|
|
|
168
|
0
|
|
0
|
|
|
0
|
my $serial = new FileHandle("+>$port") || die "Could not open $port: $!\n"; |
169
|
|
|
|
|
|
|
|
170
|
0
|
|
|
|
|
0
|
$termios = POSIX::Termios->new(); |
171
|
0
|
0
|
|
|
|
0
|
$termios->getattr($serial->fileno()) || die "getattr: $!\n"; |
172
|
0
|
|
|
|
|
0
|
$cflag = 0 | CS8() | CREAD() |CLOCAL(); |
173
|
0
|
|
|
|
|
0
|
$lflag = 0; |
174
|
0
|
|
|
|
|
0
|
$iflag = 0 | IGNBRK() |IGNPAR(); |
175
|
0
|
|
|
|
|
0
|
$oflag = 0; |
176
|
|
|
|
|
|
|
|
177
|
0
|
|
|
|
|
0
|
$termios->setcflag($cflag); |
178
|
0
|
|
|
|
|
0
|
$termios->setlflag($lflag); |
179
|
0
|
|
|
|
|
0
|
$termios->setiflag($iflag); |
180
|
0
|
|
|
|
|
0
|
$termios->setoflag($oflag); |
181
|
0
|
0
|
|
|
|
0
|
$termios->setattr($serial->fileno(),TCSANOW()) || die "setattr: $!\n"; |
182
|
0
|
|
|
|
|
0
|
eval qq[ |
183
|
|
|
|
|
|
|
\$termios->setospeed(POSIX::B$baud) || die "setospeed: \$!\n"; |
184
|
|
|
|
|
|
|
\$termios->setispeed(POSIX::B$baud) || die "setispeed: \$!\n"; |
185
|
|
|
|
|
|
|
]; |
186
|
|
|
|
|
|
|
|
187
|
0
|
0
|
|
|
|
0
|
die $@ if $@; |
188
|
|
|
|
|
|
|
|
189
|
0
|
0
|
|
|
|
0
|
$termios->setattr($serial->fileno(),TCSANOW()) || die "setattr: $!\n"; |
190
|
|
|
|
|
|
|
|
191
|
0
|
0
|
|
|
|
0
|
$termios->getattr($serial->fileno()) || die "getattr: $!\n"; |
192
|
0
|
|
|
|
|
0
|
for (0..NCCS()) { |
193
|
0
|
0
|
|
|
|
0
|
if ($_ == NCCS()) { |
194
|
0
|
|
|
|
|
0
|
last; |
195
|
|
|
|
|
|
|
} |
196
|
0
|
0
|
0
|
|
|
0
|
if ($_ == VSTART() || $_ == VSTOP()) { |
197
|
0
|
|
|
|
|
0
|
next; |
198
|
|
|
|
|
|
|
} |
199
|
0
|
|
|
|
|
0
|
$termios->setcc($_,0); |
200
|
|
|
|
|
|
|
} |
201
|
0
|
0
|
|
|
|
0
|
$termios->setattr($serial->fileno(),TCSANOW()) || die "setattr: $!\n"; |
202
|
|
|
|
|
|
|
|
203
|
0
|
|
|
|
|
0
|
$self->{serialtype} = 'FileHandle'; |
204
|
0
|
|
|
|
|
0
|
$serial; |
205
|
|
|
|
|
|
|
} |
206
|
|
|
|
|
|
|
|
207
|
|
|
|
|
|
|
sub stty_connect { |
208
|
0
|
|
|
0
|
0
|
0
|
my $self = shift; |
209
|
0
|
|
|
|
|
0
|
my $port = $self->{'port'}; |
210
|
0
|
|
|
|
|
0
|
my $baud = $self->{'baud'}; |
211
|
0
|
|
|
|
|
0
|
my($termios,$cflag,$lflag,$iflag,$oflag,$voice); |
212
|
|
|
|
|
|
|
|
213
|
0
|
0
|
|
|
|
0
|
if ($^O eq 'freebsd') { |
214
|
0
|
|
|
|
|
0
|
my $cc = join(" ", map { "$_ undef" } qw(eof eol eol2 erase erase2 werase kill quit susp dsusp lnext reprint status)); |
|
0
|
|
|
|
|
0
|
|
215
|
0
|
|
|
|
|
0
|
system("$stty_path <$port cs8 cread clocal ignbrk ignpar ospeed $baud ispeed $baud $cc"); |
216
|
0
|
0
|
|
|
|
0
|
warn "$stty_path failed" if $?; |
217
|
0
|
|
|
|
|
0
|
system("$stty_path <$port -e"); |
218
|
|
|
|
|
|
|
} else { # linux |
219
|
0
|
|
|
|
|
0
|
my $cc = join(" ", map { "$_ undef" } qw(eof eol eol2 erase werase kill intr quit susp start stop lnext rprnt flush)); |
|
0
|
|
|
|
|
0
|
|
220
|
0
|
|
|
|
|
0
|
system("$stty_path <$port cs8 clocal -hupcl ignbrk ignpar ispeed $baud ospeed $baud $cc"); |
221
|
0
|
0
|
|
|
|
0
|
die "$stty_path failed" if $?; |
222
|
0
|
|
|
|
|
0
|
system("$stty_path <$port -a"); |
223
|
|
|
|
|
|
|
} |
224
|
|
|
|
|
|
|
|
225
|
0
|
0
|
|
|
|
0
|
open(FH, "+>$port") or die "Could not open $port: $!\n"; |
226
|
0
|
|
|
|
|
0
|
$self->{serialtype} = 'FileHandle'; |
227
|
0
|
|
|
|
|
0
|
\*FH; |
228
|
|
|
|
|
|
|
} |
229
|
|
|
|
|
|
|
|
230
|
|
|
|
|
|
|
sub usleep { |
231
|
627
|
|
|
627
|
0
|
866
|
my $l = shift; |
232
|
627
|
|
33
|
|
|
3012
|
$l = ref($l) && shift; |
233
|
627
|
|
|
|
|
830621
|
select( undef,undef,undef,($l/1000)); |
234
|
|
|
|
|
|
|
} |
235
|
|
|
|
|
|
|
|
236
|
1219
|
|
|
1219
|
0
|
11519
|
sub serial { shift->{serial} } |
237
|
|
|
|
|
|
|
|
238
|
28
|
|
|
28
|
0
|
158
|
sub verbose { shift->{verbose} } |
239
|
|
|
|
|
|
|
|
240
|
|
|
|
|
|
|
|
241
|
|
|
|
|
|
|
1; |
242
|
|
|
|
|
|
|
|
243
|
|
|
|
|
|
|
|
244
|
|
|
|
|
|
|
__END__ |