WIP: Towards internal timekeeping.

[slotcarman.git] / SCX / Reader.pm

diff --git a/SCX/Reader.pm b/SCX/Reader.pm
index e3431ad425ad40e66acd33832eb2e73ed097082a..7498e0a179c430aa082ff0da3cf37f6e4b9ecc0a 100644 (file)
--- a/SCX/Reader.pm
+++ b/SCX/Reader.pm
@@ -49,6 +49,8 @@ sub new {
 
        bless $self, $class;
 
+       $self->track->reset;
+
        return $self;
 }
 
@@ -64,6 +66,8 @@ sub read {
        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";
@@ -94,6 +98,7 @@ sub read {
                my @packet = splice @bytes, 0, $PACKET_SIZE+1;
                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) {
@@ -112,7 +117,7 @@ sub log_bytes {
 
        $msg = defined $msg ? ' # ' . $msg : '';
 
-       my $now = gettimeofday;
+       my $now = $self->{last_read_time};
 
        if ($now - $self->{log_start} >= $LOG_ROTATE) {
                close $self->{logfh};
@@ -182,7 +187,7 @@ sub car_programming_packet {
                || $bytes[4] != 0xFF
                || $bytes[5] != 0xFF;
 
-       return $msg;
+       return $msg; # No need to handle this
 }
 
 sub reset_packet {
@@ -194,6 +199,8 @@ sub reset_packet {
                || $bytes[4] != 0xAA
                || $bytes[5] != 0xAA;
 
+       $self->track->reset;
+
        return $msg; # FIXME - to be implemented
 }
 
@@ -226,7 +233,33 @@ sub lap_time_packet {
                || $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;
 }
 
 
@@ -241,7 +274,13 @@ sub race_setup_packet {
                || $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;
 }
 
 
@@ -289,7 +328,9 @@ sub qualification_packet {
                || $bytes[4] != 0xFF
                || $bytes[5] != 0xFF;
 
-       return $msg; # FIXME - to be implemented
+       $self->track->qualification_start;
+
+       return $msg;
 }
 
 
@@ -304,7 +345,9 @@ sub end_of_race_packet {
                || $bytes[4] != 0xFF
                || $bytes[5] != 0xFF;
 
-       return $msg; # FIXME - to be implemented
+       $self->track->race_end;
+
+       return $msg;
 }
 
 
@@ -319,7 +362,9 @@ sub race_start_packet {
                || $bytes[4] != 0xAA
                || $bytes[5] != 0xAA;
 
-       return $msg; # FIXME - to be implemented
+       $self->track->race_start;
+
+       return $msg;
 }
 
 
@@ -353,16 +398,37 @@ sub finish_line_packet {
        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;
+       }
+
+       my $processed;
+       for my $car (@cars_finished) {
+               $processed ||= $self->track->car($car)->finish_line(
+                       $self->{last_read_time}, $regular
+               );
+       }
+
+       if ($processed) {
+               $self->track->recalc_order;
+       }
+
+       return $msg;
+}
 
 sub controller_status_packet {
        my ($self, @bytes) = @_;
 
        my $fail;
        for my $byte (@bytes) {
-               next if $byte == 0xA0;
+               next if $byte == 0xAA;
                $fail = 1
                        if ($byte & 0xC0) != 0xC0
                        || ($byte & 0x0F) > 12