5 use Time::HiRes qw(gettimeofday tv_interval);
10 our $LOG_ROTATE = 600;
13 my ($class, $args) = @_;
15 my $callback = $args->{callback}
16 or die "callback arg not defined";
18 my $portname = $args->{portname}
19 or die "portname not specified";
21 system 'stty', '-F', $portname, '115200', 'raw';
23 die "stty died with code $? (no permissions?)";
26 open my $tty, '<:raw', $portname
27 or die "Can't open $portname: $!";
29 my $logfile = $args->{logfile};
32 open my $logfh, '>', "$logfile.$log_gen"
33 or die "Can't open $logfile.$log_gen: $!";
35 my $now = gettimeofday;
38 portname => $portname,
45 callback => $callback,
54 sub fh { return shift->{fh}; }
60 my $bytes_read = sysread $self->fh, $data, $PACKET_SIZE;
61 die "Read error on $self->{portname}: $!"
64 my $now = gettimeofday;
65 if ($now - $self->{log_start} >= $LOG_ROTATE) {
67 $self->{log_gen} = $self->{log_gen} ? 0 : 1;
68 open my $fh, '>', $logfile . '.' . $self->{log_gen}
69 or die "Can't open $logfile.$self->{log_gen}: $!";
71 $self->{log_start} = $now;
74 my @bytes = unpack("C*", $data);
76 $self->{logfh}->print(sprintf('% 10.3f', $now - $self->{starttime}),
77 (map { sprintf(" %02x", $_) } @bytes),
80 push @{ $self->{bytes} }, @bytes;
81 @bytes = @{ $self->{bytes} };
86 if ($bytes[0] != 0x55) {
87 push @bad_bytes, shift @bytes;
92 my $packet_size = $cmd >= 0x40 && $cmd <= 0x46 ? 4 : 9;
93 last if @bytes <= $packet_size;
95 if ($bytes[$packet_size] != 0x05
96 || SCX::CRC::digest(@bytes[0..$packet_size-2])
97 != $bytes[$packet_size-1]) {
98 push @bad_bytes, shift @bytes;
103 $self->{logfh}->print("Cannot parse bytes",
104 (map { sprintf(' %02x', $_) } @bad_bytes),
109 $self->{logfh}->print("Callback\n");
110 &{ $self->{callback} }(@bytes[1..$packet_size]);
111 splice @bytes, 0, $packet_size+1;
114 $self->{logfh}->print("Cannot parse bytes",
115 (map { sprintf(' %02x', $_) } @bad_bytes),
120 @{ $self->{bytes} } = @bytes;