--- mdap-server.pl	2007/04/22 14:41:18	3
+++ mdap-server.pl	2007/04/22 15:32:22	7
@@ -10,6 +10,29 @@
 my $local_port = 1000;
 
 my $resend_search_delay = 3;
+my $tftp_path = '/srv/tftp/';
+
+sub fw {
+	my ($board, $offset,$len) = @_;
+	open(my $fh, "$tftp_path/$board") || die "Can't open image $tftp_path/$board: $!";
+	my $b;
+	seek($fh, $offset, 0) || die "can't seek to $offset: $!";
+	read($fh, $b, $len) || die "can't read $len bytes from $offset: $!";
+	close($fh);
+	return $b;
+}
+
+sub fw_build {
+	my $board_name = shift || return 0;
+	my $v = join('.', unpack('CCCC',fw($board_name,0x20,4)) );
+	print "# fw_build $board_name $v\n";
+	return $v;
+}
+
+sub fw_exists {
+	my $board = shift;
+	return -e "$tftp_path/$board";
+}
 
 my $sock = IO::Socket::Multicast->new(LocalPort=>PORT,ReuseAddr=>1);
 $sock->mcast_add(GROUP) || die "Couldn't set group: $!\n";
@@ -40,6 +63,8 @@
 
 alarm( $resend_search_delay );
 
+mdap_send("ANT-SEARCH MDAP/1.1\r\n46");
+
 while (1) {
 	my $data;
 	next unless $sock->recv($data,1024);
@@ -50,22 +75,26 @@
 
 		my $h = ant2hash($data);
 
+		my $ant = $h->{'ANT-ID'} || die "no ANT-ID in ", dump( $h );
+
 		print "# $type $proto ", dump( $h ), $/;
 
 		if ($type eq 'REPLY-ANT-SEARCH') {
-			mdap_send("INFO MDAP/1.2\r\nSEQ-NR:1\r\nTO-ANT:0644JTHJ4\r\nUSER-ID:Administrator\r\nUSER-PWD:\r\n22");
+			mdap_send("INFO MDAP/1.2\r\nSEQ-NR:1\r\nTO-ANT:$ant\r\nUSER-ID:Administrator\r\nUSER-PWD:\r\n22");
 		} elsif ($type eq 'REPLY-INFO') {
-			if (
-				$h->{'_BUILD'} eq '6.1.7.2' &&
-				$h->{'_BUILDNAME'} eq 'ZZO9AA6.172' &&
-				$h->{'_BUILDVARIANT'} eq 'AA' &&
-				1
-			) {
-				mdap_send("EXEC-CLI MDAP/1.2\r\nCLI-CMD:software upgrade\r\nSEQ-NR:1\r\nTO-ANT:0644JTHJ4\r\nUSER-ID:Administrator\r\nUSER-PWD:\r\n1F");
+			my $board = $h->{'_BOARD_NAME'} || die "no _BOARD_NAME?";
+			if ( fw_exists( $board ) ) {
+				if ( $h->{'_BUILD'} ne fw_build( $board ) ) {
+					print "UPDATE STEP 1 on ant $ant\n";
+					mdap_send("EXEC-CLI MDAP/1.2\r\nCLI-CMD:software upgrade\r\nSEQ-NR:1\r\nTO-ANT:$ant\r\nUSER-ID:Administrator\r\nUSER-PWD:\r\n1F");
+				} else {
+					print "OK ant $ant allready updated...\n";
+				}
 			} else {
-				print "skipped updating ", 
+				print "!! NO FIRMWARE for $board in $tftp_path for ant $ant, skipping update\n";
 			}
 		} elsif ( $type eq 'REPLY-EXEC-CLI' && $h->{'SEQ-NR'} == 1 ) {
+				print "UPDATE STEP 2 on ant $ant\n";
 				mdap_send("EXEC-CLI MDAP/1.2\r\nSEQ-NR:2\r\nTO-ANT:0644JTHJ4\r\nUSER-ID:Administrator\r\nUSER-PWD:\r\n5F");
 		} else {
 			print "!! reply ignored\n";