From: Jan "Yenya" Kasprzak <kas@fi.muni.cz>
Date: Fri, 3 Dec 2010 17:44:41 +0000 (+0100)
Subject: Reader: skeleton functions for all packet types.
X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?a=commitdiff_plain;h=32547a84e1959917750d2ce8fe4b6157c2c33a09;p=slotcarman.git

Reader: skeleton functions for all packet types.
---

diff --git a/SCX/Reader.pm b/SCX/Reader.pm
index 23f33ea..c60ec95 100644
--- a/SCX/Reader.pm
+++ b/SCX/Reader.pm
@@ -88,7 +88,7 @@ sub read {
 		}
 
 		my @packet = splice @bytes, 0, $PACKET_SIZE+1;
-		my $rv = &{ $self->{callback} }(@packet[1..$PACKET_SIZE]);
+		my $rv = &{ $self->{callback} }(@packet);
 		$self->log_bytes(@packet, $rv);
 	}
 	$self->log_bad_bytes(\@bad_bytes, "Cannot parse packet");
@@ -115,9 +115,279 @@ sub log_bytes {
 	}
 
 	$self->{logfh}->print(sprintf('% 10.3f', $now - $self->{starttime}),
-		(map { sprintf(" %02x", $_) } @bytes),
+		(map { sprintf(" %02x", $_) } @$bytes),
 		$msg, "\n");
 }
 
+our %COMMANDS = (
+	0xAA => \&bus_free_time_packet,
+	0xCC => \&car_programming_packet,
+	0xD0 => \&reset_packet,
+	0xD3 => \&standings_packet,
+	0xD4 => \&lap_time_packet,
+	0xD5 => \&race_setup_packet,
+	0xD6 => \&fuel_level_packet,
+	0xD7 => \&brake_set_packet,
+	0xDB => \&qualification_packet,
+	0xDC => \&end_of_race_packet,
+	0xDD => \&race_start_packet,
+	0xDE => \&display_change_packet,
+	0xEE => \&finish_line_packet,
+	0xFF => \&controller_status_packet,
+);
+
+sub handle_packet {
+	my ($self, @data) = @_;
+
+	my $cmd = $data[1];
+	my @args = $data[2..7];
+
+	my $sub = $COMMANDS{$cmd};
+	return "Unknown packet"
+		if !defined $sub;
+
+	return &$sub($self, @args);
+}
+
+sub bus_free_time_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange bus free time packet'
+		if $bytes[2] != 0xF0
+		|| $bytes[3] != 0xF0
+		|| $bytes[4] != 0xF0
+		|| $bytes[5] != 0xF0;
+
+	return $msg; # No need to handle this, I think
+}
+
+sub car_programming_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange car programming packet'
+		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;
+}
+
+sub reset_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange reset packet'
+		if $bytes[0] != 0xFF
+		|| $bytes[3] != 0xAA
+		|| $bytes[4] != 0xAA
+		|| $bytes[5] != 0xAA;
+
+	return $msg; # FIXME - to be implemented
+}
+
+sub standings_packet {
+	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;
+
+	return $msg; # FIXME - to be implemented
+}
+
+sub lap_time_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange lap time packet'
+		if $bytes[0] > 5
+		|| $bytes[1] & 0x01
+		|| $bytes[2] & 0x01
+		|| $bytes[3] & 0xF8 != 0
+		|| $bytes[4] & 0x01
+		|| $bytes[5] & 0x01;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub race_setup_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange race setup packet'
+		if ($bytes[0] != 0x00 && $bytes[0] != 0xFF)
+		|| $bytes[1] & 0xF0
+		|| $bytes[2] & 0xF0
+		|| $bytes[3] & 0xF0
+		|| $bytes[4] != 0xFF
+		|| $bytes[5] != 0xFF;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub fuel_level_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange fuel_level packet'
+		if ($bytes[0] >> 4) > 8
+		|| $bytes[0] & 0x0F > 8
+		|| ($bytes[1] >> 4) > 8
+		|| $bytes[1] & 0x0F > 8
+		|| ($bytes[2] >> 4) > 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
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub brake_set_packet {
+	my ($self, @bytes) = @_;
+
+	return 'Unexpected brake_set packet (should be in the pit lane only)';
+}
+
+
+sub qualification_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange qualification packet'
+		if $bytes[0] & 0xF0
+		|| $bytes[1] & 0xF0
+		|| $bytes[2] & 0xF0
+		|| $bytes[3] > 5
+		|| $bytes[4] != 0xFF
+		|| $bytes[5] != 0xFF;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub end_of_race_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange end_of_race packet'
+		if $bytes[0] != 0xFF
+		|| $bytes[1] != 0xFF
+		|| $bytes[2] != 0xFF
+		|| $bytes[3] != 0xFF
+		|| $bytes[4] != 0xFF
+		|| $bytes[5] != 0xFF;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub race_start_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange race_start packet'
+		if $bytes[0] != 0x00
+		|| $bytes[1] != 0xAA
+		|| $bytes[2] != 0xAA
+		|| $bytes[3] != 0xAA
+		|| $bytes[4] != 0xAA
+		|| $bytes[5] != 0xAA;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub display_change_packet {
+	my ($self, @bytes) = @_;
+
+	my $msg = 'Strange display_change packet'
+		if $bytes[0] & 0xFE
+		|| $bytes[1] != 0xFF
+		|| $bytes[2] != 0xFF
+		|| $bytes[3] != 0xFF
+		|| $bytes[4] != 0xFF
+		|| $bytes[5] != 0xFF;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub finish_line_packet {
+	my ($self, @bytes) = @_;
+
+	my $fail;
+	for my $byte (@bytes) {
+		$fail = 1
+			if $byte != 0xAA
+			&& $byte != 0xE7
+			&& $byte != 0xF0
+			&& $byte != 0xFE
+	}
+
+	my $msg = 'Strange finish_line packet'
+		if $fail;
+
+	return $msg; # FIXME - to be implemented
+}
+
+
+sub controller_status_packet {
+	my ($self, @bytes) = @_;
+
+	my $fail;
+	for my $byte (@bytes) {
+		$fail = 1
+			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);
+		}
+=cut
+
+	return $msg; # FIXME - to be implemented
+}
+
 1;