package SCX::Reader;
+use strict;
+
use Time::HiRes qw(gettimeofday tv_interval);
use FileHandle;
+use IO::Handle;
+use POSIX;
use SCX::CRC;
our $PACKET_SIZE = 9; # 9 bytes + 0x05
sub new {
my ($class, $args) = @_;
- my $callback = $args->{callback}
- or die "callback arg not defined";
-
my $portname = $args->{portname}
or die "portname not specified";
die "stty died with code $? (no permissions?)";
}
- open my $tty, '<:raw', $portname
+ sysopen(my $fh, $portname, O_RDONLY|O_NONBLOCK)
or die "Can't open $portname: $!";
my $logfile = $args->{logfile};
my $self = {
portname => $portname,
- fh => $tty,
+ fh => $fh,
logfile => $logfile,
logfh => $logfh,
log_gen => $log_gen,
log_start => $now,
starttime => $now,
- callback => $callback,
+ track => $args->{track},
bytes => [],
};
bless $self, $class;
+ $self->track->reset;
+
return $self;
}
sub fh { return shift->{fh}; }
+sub track { return shift->{track}; }
+
sub read {
my ($self) = @_;
die "Read error on $self->{portname}: $!"
if !$bytes_read;
+ $self->{last_read_time} = gettimeofday;
+
my @bytes = unpack("C*", $data);
+ # print join(' ', map { sprintf(" %02x", $_) } @bytes), "\n";
push @{ $self->{bytes} }, @bytes;
@bytes = @{ $self->{bytes} };
}
my @packet = splice @bytes, 0, $PACKET_SIZE+1;
- my $rv = &{ $self->{callback} }(@packet);
- $self->log_bytes(@packet, $rv);
+ my $rv = $self->handle_packet(@packet);
+ $self->log_bytes(\@packet, $rv);
+ $self->track->packet_received($self->{last_read_time});
+ }
+ if (@bad_bytes) {
+ while (@bytes && $bytes[0] != 0x55) {
+ push @bad_bytes, shift @bytes;
+ }
+ $self->log_bytes(\@bad_bytes, "cannot parse packet");
}
- $self->log_bad_bytes(\@bad_bytes, "Cannot parse packet");
@{ $self->{bytes} } = @bytes;
}
$msg = defined $msg ? ' # ' . $msg : '';
- my $now = gettimeofday;
+ my $now = $self->{last_read_time};
if ($now - $self->{log_start} >= $LOG_ROTATE) {
close $self->{logfh};
$self->{log_gen} = $self->{log_gen} ? 0 : 1;
- open my $fh, '>', $logfile . '.' . $self->{log_gen}
- or die "Can't open $logfile.$self->{log_gen}: $!";
+ open my $fh, '>', $self->{logfile} . '.' . $self->{log_gen}
+ or die "Can't open $self->{logfile}.$self->{log_gen}: $!";
$self->{logfh} = $fh;
$self->{log_start} = $now;
}
$self->{logfh}->print(sprintf('% 10.3f', $now - $self->{starttime}),
(map { sprintf(" %02x", $_) } @$bytes),
$msg, "\n");
+ $self->{logfh}->flush;
}
our %COMMANDS = (
my ($self, @data) = @_;
my $cmd = $data[1];
- my @args = $data[2..7];
+ my @args = @data[2..7];
my $sub = $COMMANDS{$cmd};
return "Unknown packet"
my ($self, @bytes) = @_;
my $msg = 'Strange car programming packet'
- if $bytes[0] & 0xF8 != 0 || $bytes[0] & 0x07 > 5
+ if ($bytes[0] & 0xF8) != 0 || ($bytes[0] & 0x07) > 5
|| $bytes[1] != 0xFE
|| $bytes[2] != 0xFF
|| $bytes[3] != 0xFF
|| $bytes[4] != 0xFF
|| $bytes[5] != 0xFF;
- return $msg;
+ return $msg; # No need to handle this
}
sub reset_packet {
|| $bytes[4] != 0xAA
|| $bytes[5] != 0xAA;
+ $self->track->reset;
+
return $msg; # FIXME - to be implemented
}
my ($self, @bytes) = @_;
my $msg = 'Strange standings packet'
- if $bytes[0] & 0x07 > 5
- || $bytes[1] & 0x07 > 5
- || $bytes[2] & 0x07 > 5
- || $bytes[3] & 0x07 > 5
- || $bytes[4] & 0x07 > 5
- || $bytes[5] & 0x07 > 5;
+ if ($bytes[0] != 0xFF && ($bytes[0] & 0x07) > 5)
+ || ($bytes[1] != 0xFF && ($bytes[1] & 0x07) > 5)
+ || ($bytes[2] != 0xFF && ($bytes[2] & 0x07) > 5)
+ || ($bytes[3] != 0xFF && ($bytes[3] & 0x07) > 5)
+ || ($bytes[4] != 0xFF && ($bytes[4] & 0x07) > 5)
+ || ($bytes[5] != 0xFF && ($bytes[5] & 0x07) > 5);
+
+ my @standings;
+
+ push @standings, map { $_ != 0xFF ? $_ & (0x07) : () } @bytes;
return $msg; # FIXME - to be implemented
}
if $bytes[0] > 5
|| $bytes[1] & 0x01
|| $bytes[2] & 0x01
- || $bytes[3] & 0xF8 != 0
+ || ($bytes[3] & 0xF0) != 0
|| $bytes[4] & 0x01
|| $bytes[5] & 0x01;
- return $msg; # FIXME - to be implemented
+=comment
+ # Moving to internal timekeeping
+ my $nonzero = grep { $_ != 0 } @bytes;
+
+ my $car = $bytes[0];
+ my $round = 256*$bytes[1] + $bytes[2]
+ + ($bytes[3] & 2 ? 256 : 0)
+ + ($bytes[3] & 1 ? 1 : 0);
+ my $time = 256*$bytes[4] + $bytes[5]
+ + ($bytes[3] & 8 ? 256 : 0)
+ + ($bytes[3] & 4 ? 1 : 0);
+ if ($time == 65535) {
+ $self->track->car($car)->enter_pit_lane;
+ } else {
+ $time *= 0.01024;
+
+ if ($nonzero) {
+ $self->track->car($car)->set_lap($round);
+ $self->track->car($car)->set_laptime($time);
+ } else {
+ # FIXME - probably reset race time or whatever
+ # all-zeros packet is sent after the race setup
+ }
+ }
+=cut
+
+ return $msg;
}
|| $bytes[4] != 0xFF
|| $bytes[5] != 0xFF;
- return $msg; # FIXME - to be implemented
+ $self->track->race_setup($bytes[0] == 0x00
+ ? 0
+ : ($bytes[1] & 0x0F) * 256
+ + ($bytes[2] & 0x0F) * 16
+ + ($bytes[3] & 0x0F));
+
+ return $msg;
}
my $msg = 'Strange fuel_level packet'
if ($bytes[0] >> 4) > 8
- || $bytes[0] & 0x0F > 8
+ || ($bytes[0] & 0x0F) > 8
|| ($bytes[1] >> 4) > 8
- || $bytes[1] & 0x0F > 8
+ || ($bytes[1] & 0x0F) > 8
|| ($bytes[2] >> 4) > 8
- || $bytes[2] & 0x0F > 8
+ || ($bytes[2] & 0x0F) > 8
|| ($bytes[5] != 0xAA && $bytes[5] != 0xFF);
-=comment
- my @fuel = (0,
- $data[1] >> 4, $data[1] & 0x0f,
- $data[2] >> 4, $data[2] & 0x0f,
- $data[3] >> 4, $data[3] & 0x0f,
- );
- for my $car (1..6) {
- next if defined $controllers[$car-1]
- &&$controllers[$car-1] == $fuel[$car];
-
- my $progressbar = $builder->get_object(
- 'progressbar_fuel'.$car);
- $progressbar->set_fraction($fuel[$car]/8);
- }
-=cut
+ my @fuel = (
+ $bytes[0] >> 4, $bytes[0] & 0x0f,
+ $bytes[1] >> 4, $bytes[1] & 0x0f,
+ $bytes[2] >> 4, $bytes[2] & 0x0f,
+ );
- return $msg; # FIXME - to be implemented
+ for my $car (0..5) {
+ $self->track->car($car)->set_fuel($fuel[$car]);
+ }
+
+ return $msg;
}
|| $bytes[4] != 0xFF
|| $bytes[5] != 0xFF;
- return $msg; # FIXME - to be implemented
+ $self->track->qualification_start;
+
+ return $msg;
}
|| $bytes[4] != 0xFF
|| $bytes[5] != 0xFF;
- return $msg; # FIXME - to be implemented
+ $self->track->race_end;
+
+ return $msg;
}
|| $bytes[4] != 0xAA
|| $bytes[5] != 0xAA;
- return $msg; # FIXME - to be implemented
+ $self->track->race_start;
+
+ return $msg;
}
my $msg = 'Strange finish_line packet'
if $fail;
- return $msg; # FIXME - to be implemented
-}
+ my $regular = 1;
+ my @cars_finished;
+ for my $i (0..5) {
+ my $byte = $bytes[$i];
+
+ $regular = 0
+ if $byte != 0xAA && $byte != 0xE7 && $byte != 0xFE;
+
+ push @cars_finished, $i if $byte == 0xE7;
+ }
+
+ $self->track->finish_line(
+ $self->{last_read_time},
+ $regular,
+ @cars_finished
+ );
+ return $msg;
+}
sub controller_status_packet {
my ($self, @bytes) = @_;
my $fail;
for my $byte (@bytes) {
+ next if $byte == 0xAA;
$fail = 1
- if $byte & 0xC0 != 0xC0
- || $byte & 0x0F > 12
+ if ($byte & 0xC0) != 0xC0
+ || ($byte & 0x0F) > 12
}
my $msg = 'Strange controller_status packet'
if $fail;
-=comment
- for my $controller (1..6) {
- my $byte = $data[$controller];
- next if defined $controllers[$controller-1]
- && $controllers[$controller-1] == $byte;
- $controllers[$controller-1] = $byte;
-
- my $progressbar = $builder->get_object(
- 'progressbar_controller'.$controller);
- if ($byte == 0xaa) {
- $progressbar->set_text('inactive');
- $progressbar->set_fraction(0);
- next;
- }
- my $light = !($byte & 0x20);
- my $backbutton = !($byte & 0x10);
- my $speed = $byte & 0x0f;
-
- my $text = ($backbutton ? '+' : '') . $speed;
- $progressbar->set_text($text);
- $progressbar->set_fraction($speed / 12);
+ my @fuel = (
+ $bytes[1] >> 4, $bytes[1] & 0x0f,
+ $bytes[2] >> 4, $bytes[2] & 0x0f,
+ $bytes[3] >> 4, $bytes[3] & 0x0f,
+ );
+
+ for my $car (0..5) {
+ my $byte = $bytes[$car];
+
+ if ($byte == 0xAA) {
+ $self->track->car($car)->set_throttle(undef, undef,
+ $self->{last_read_time});
+ next;
}
-=cut
- return $msg; # FIXME - to be implemented
+ my $light = !($byte & 0x20);
+ my $backbutton = !($byte & 0x10);
+ my $throttle = $byte & 0x0f;
+
+ $self->track->car($car)->set_throttle($throttle, $backbutton,
+ $self->{last_read_time});
+ $self->track->car($car)->set_light($light);
+ }
+
+ return $msg;
}
1;
https://www.fi.muni.cz/~kas/git / slotcarman.git / blobdiff