| line |
stmt |
bran |
cond |
sub |
pod |
time |
code |
|
1
|
|
|
|
|
|
|
# Copyright (c) 1999-2000 João Pedro Gonçalves . |
|
2
|
|
|
|
|
|
|
#All rights reserved. This program is free software; |
|
3
|
|
|
|
|
|
|
#you can redistribute it and/or modify it under the same terms as Perl itself. |
|
4
|
|
|
|
|
|
|
|
|
5
|
|
|
|
|
|
|
package GPS::NMEA; |
|
6
|
|
|
|
|
|
|
|
|
7
|
2
|
|
|
2
|
|
2388
|
use GPS::Base (); |
|
|
2
|
|
|
|
|
3
|
|
|
|
2
|
|
|
|
|
43
|
|
|
8
|
2
|
|
|
2
|
|
382
|
use GPS::Serial (); |
|
|
2
|
|
|
|
|
4
|
|
|
|
2
|
|
|
|
|
38
|
|
|
9
|
2
|
|
|
2
|
|
1037
|
use GPS::NMEA::Handler (); |
|
|
2
|
|
|
|
|
5
|
|
|
|
2
|
|
|
|
|
56
|
|
|
10
|
|
|
|
|
|
|
|
|
11
|
2
|
|
|
2
|
|
12
|
use strict; |
|
|
2
|
|
|
|
|
3
|
|
|
|
2
|
|
|
|
|
49
|
|
|
12
|
2
|
|
|
2
|
|
9
|
use Carp; |
|
|
2
|
|
|
|
|
6
|
|
|
|
2
|
|
|
|
|
126
|
|
|
13
|
2
|
|
|
2
|
|
11
|
use vars qw($VERSION @ISA); |
|
|
2
|
|
|
|
|
4
|
|
|
|
2
|
|
|
|
|
163
|
|
|
14
|
|
|
|
|
|
|
|
|
15
|
|
|
|
|
|
|
require Exporter; |
|
16
|
|
|
|
|
|
|
|
|
17
|
|
|
|
|
|
|
@ISA = qw(GPS::Base GPS::Serial GPS::NMEA::Handler); |
|
18
|
|
|
|
|
|
|
|
|
19
|
|
|
|
|
|
|
$VERSION = sprintf("%d.%02d", q$Revision: 1.11 $ =~ /(\d+)\.(\d+)/); |
|
20
|
|
|
|
|
|
|
|
|
21
|
2
|
|
|
2
|
|
26
|
use FileHandle; |
|
|
2
|
|
|
|
|
2
|
|
|
|
2
|
|
|
|
|
6
|
|
|
22
|
|
|
|
|
|
|
|
|
23
|
|
|
|
|
|
|
sub new { |
|
24
|
3
|
|
|
3
|
0
|
1988
|
my $class = shift; |
|
25
|
3
|
|
|
|
|
9
|
my %param = @_; |
|
26
|
3
|
|
50
|
|
|
17
|
$param{'Protocol'} ||= 'NMEA'; |
|
27
|
|
|
|
|
|
|
|
|
28
|
3
|
|
|
|
|
18
|
my $self = $class->SUPER::common_new(%param); |
|
29
|
3
|
|
|
|
|
4
|
bless $self, $class; |
|
30
|
|
|
|
|
|
|
|
|
31
|
3
|
|
|
|
|
8
|
$self; |
|
32
|
|
|
|
|
|
|
} |
|
33
|
|
|
|
|
|
|
|
|
34
|
|
|
|
|
|
|
sub parse { |
|
35
|
14
|
|
|
14
|
0
|
36
|
my $self = shift; |
|
36
|
14
|
|
|
|
|
58
|
my $line = $self->_readline; #from GPS::Serial |
|
37
|
|
|
|
|
|
|
|
|
38
|
14
|
|
|
|
|
32
|
my ($csum,$cmd,$short_cmd); |
|
39
|
|
|
|
|
|
|
|
|
40
|
|
|
|
|
|
|
#remove trailing chars |
|
41
|
14
|
|
|
|
|
62
|
chomp($line);$line =~ s/\r//g; |
|
|
14
|
|
|
|
|
115
|
|
|
42
|
|
|
|
|
|
|
|
|
43
|
|
|
|
|
|
|
#Test checksum |
|
44
|
14
|
50
|
|
|
|
235
|
if ($line =~ s/\*(\w\w)$//) { |
|
45
|
14
|
|
|
|
|
69
|
$csum = $1; |
|
46
|
14
|
50
|
|
|
|
82
|
return $self->parse(@_) unless $csum eq $self->checksum($line); |
|
47
|
|
|
|
|
|
|
} |
|
48
|
|
|
|
|
|
|
|
|
49
|
14
|
|
|
|
|
133
|
$cmd = (split ',',$line)[0]; |
|
50
|
14
|
|
|
|
|
97
|
($short_cmd = $cmd) =~ s/^\$//; |
|
51
|
|
|
|
|
|
|
|
|
52
|
14
|
50
|
|
|
|
72
|
print "COMMAND: $short_cmd ($line)\n" if $self->verbose; |
|
53
|
14
|
50
|
|
|
|
460
|
if ($self->can($short_cmd)) { |
|
|
|
0
|
|
|
|
|
|
|
54
|
14
|
|
|
|
|
91
|
$self->$short_cmd($line); |
|
55
|
|
|
|
|
|
|
} elsif ($self->verbose) { |
|
56
|
0
|
|
|
|
|
0
|
print "Can't handle $short_cmd\n"; |
|
57
|
|
|
|
|
|
|
} |
|
58
|
14
|
|
|
|
|
79
|
$short_cmd; |
|
59
|
|
|
|
|
|
|
} |
|
60
|
|
|
|
|
|
|
|
|
61
|
|
|
|
|
|
|
|
|
62
|
|
|
|
|
|
|
sub get_position { |
|
63
|
|
|
|
|
|
|
#($latsign,$lat,$lonsign,$lon) |
|
64
|
2
|
|
|
2
|
0
|
1815
|
my $self = shift; |
|
65
|
|
|
|
|
|
|
|
|
66
|
2
|
|
|
|
|
7
|
until ($self->parse eq 'GPRMC') { |
|
67
|
12
|
|
|
|
|
57
|
1; |
|
68
|
|
|
|
|
|
|
} |
|
69
|
|
|
|
|
|
|
; #Recommended minimum specific |
|
70
|
2
|
|
|
|
|
7
|
my $d = $self->{NMEADATA}; |
|
71
|
|
|
|
|
|
|
return ($d->{lat_NS}, |
|
72
|
|
|
|
|
|
|
$self->parse_ddmm_coords($d->{lat_ddmm}), |
|
73
|
|
|
|
|
|
|
$d->{lon_EW}, |
|
74
|
2
|
|
|
|
|
49
|
$self->parse_ddmm_coords($d->{lon_ddmm})); |
|
75
|
|
|
|
|
|
|
} |
|
76
|
|
|
|
|
|
|
|
|
77
|
|
|
|
|
|
|
sub get_altitude { |
|
78
|
0
|
|
|
0
|
0
|
0
|
my $self = shift; |
|
79
|
0
|
|
|
|
|
0
|
until ($self->parse eq 'PGRMZ') { |
|
80
|
0
|
|
|
|
|
0
|
1; |
|
81
|
|
|
|
|
|
|
} |
|
82
|
|
|
|
|
|
|
; #Altitude |
|
83
|
0
|
|
|
|
|
0
|
my $d = $self->{NMEADATA}; |
|
84
|
0
|
|
|
|
|
0
|
return ($d->{alt}/0.3048); #Metric |
|
85
|
|
|
|
|
|
|
} |
|
86
|
|
|
|
|
|
|
|
|
87
|
|
|
|
|
|
|
sub parse_ddmm_coords { |
|
88
|
4
|
|
|
4
|
0
|
11
|
my $self = shift; |
|
89
|
4
|
|
|
|
|
8
|
$_ = shift; |
|
90
|
4
|
|
|
|
|
4
|
my $deg; |
|
91
|
4
|
|
|
|
|
16
|
my ($dm,$sec) = split(/\./); |
|
92
|
|
|
|
|
|
|
|
|
93
|
4
|
100
|
|
|
|
15
|
if (length($dm) == 4) { #Lat (ddmm) |
|
|
|
50
|
|
|
|
|
|
|
94
|
2
|
|
|
|
|
7
|
$deg = substr($dm,0,2,''); |
|
95
|
|
|
|
|
|
|
} elsif (length($dm) == 5) { #Lon (dddmm) |
|
96
|
2
|
|
|
|
|
5
|
$deg = substr($dm,0,3,''); |
|
97
|
|
|
|
|
|
|
|
|
98
|
|
|
|
|
|
|
} else { |
|
99
|
0
|
|
|
|
|
0
|
carp "Invalid coords\n"; |
|
100
|
|
|
|
|
|
|
} |
|
101
|
|
|
|
|
|
|
|
|
102
|
4
|
|
|
|
|
21
|
$deg = sprintf("%d",$deg); |
|
103
|
4
|
|
|
|
|
27
|
return "$deg.$dm$sec"; |
|
104
|
|
|
|
|
|
|
} |
|
105
|
|
|
|
|
|
|
|
|
106
|
|
|
|
|
|
|
|
|
107
|
|
|
|
|
|
|
|
|
108
|
|
|
|
|
|
|
sub nmea_data_dump { |
|
109
|
|
|
|
|
|
|
#dumps data received |
|
110
|
0
|
|
|
0
|
0
|
0
|
my $self = shift; |
|
111
|
0
|
|
|
|
|
0
|
my $d = $self->{NMEADATA}; |
|
112
|
0
|
|
|
|
|
0
|
print map {"$_ => $$d{$_}\n"} sort keys %{$self->{NMEADATA}}; |
|
|
0
|
|
|
|
|
0
|
|
|
|
0
|
|
|
|
|
0
|
|
|
113
|
|
|
|
|
|
|
} |
|
114
|
|
|
|
|
|
|
|
|
115
|
|
|
|
|
|
|
# Calculate the checksum |
|
116
|
|
|
|
|
|
|
# |
|
117
|
|
|
|
|
|
|
sub checksum { |
|
118
|
14
|
|
|
14
|
0
|
30
|
my ($self,$line) = @_; |
|
119
|
14
|
|
|
|
|
30
|
my $csum = 0; |
|
120
|
14
|
|
|
|
|
422
|
$csum ^= unpack("C",(substr($line,$_,1))) for(1..length($line)-1); |
|
121
|
|
|
|
|
|
|
|
|
122
|
14
|
50
|
|
|
|
87
|
print "Checksum: $csum\n" if $self->verbose; |
|
123
|
14
|
|
|
|
|
280
|
return (sprintf("%2.2X",$csum)); |
|
124
|
|
|
|
|
|
|
} |
|
125
|
|
|
|
|
|
|
|
|
126
|
|
|
|
|
|
|
|
|
127
|
|
|
|
|
|
|
|
|
128
|
|
|
|
|
|
|
1; |
|
129
|
|
|
|
|
|
|
__END__ |