--- mdap-server.pl	2007/04/22 12:52:15	2
+++ mdap-server.pl	2007/04/23 17:42:42	17
@@ -7,9 +7,54 @@
 use constant GROUP => '224.0.0.103';
 use constant PORT  => '3235';
 
-my $local_port = 1000;
+my $debug = shift @ARGV;
 
 my $resend_search_delay = 3;
+my $tftp_path = '/srv/tftp/';
+
+# tab-delimited list of user id/passwd to try on ants
+my @try_accounts = ( "Administrator\t" );
+
+my $passwd_path = $0;
+$passwd_path =~ s/[^\/]+$/passwd/;
+
+if (-e $passwd_path) {
+	open(my $fh, $passwd_path) || die "can't open $passwd_path: $!";
+	while(<$fh>) {
+		chomp;
+		next if /^#/ || /^$/ || /^\s+$/;
+		if (/^\S+\t\S+$/) {
+			push @try_accounts, $_;
+		} else {
+			warn "invalid $passwd_path entry: $_\n";
+		}
+	}
+	print "found ", $#try_accounts, " accounts to try on password protected ants\n";
+}
+
+warn "search for ants every ${resend_search_delay}s\ntftp server path: $tftp_path\n";
+
+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";
@@ -29,59 +74,101 @@
 
 sub mdap_send {
 	my $data = shift;
-	warn ">> $data\n>>----------\n";
-	my $null = chr(0);
-	$sock->mcast_send( "${data}", GROUP . ':' . PORT );
+
+	my $xor = 0;
+	map { $xor ^= ord($_) } split(//,$data);
+	$data .= sprintf('%02X', $xor);
+
+	$sock->mcast_send( $data, GROUP . ':' . PORT );
+	if ($debug) {
+		warn ">> ", dump( $data ), $/;
+	} else {
+		$data =~ s/\s+/ /gi;
+		warn ">> ", substr($data,0,70), $/;
+	}
+}
+
+my $ant_passwd_try;
+
+sub ant_credentials {
+	my $ant = shift || die "no ant?";
+	my $i = $ant_passwd_try->{$ant} || 0;
+	my ($user_id,$user_pwd) = split(/\t/, $try_accounts[$i]);
+	#warn "ant $ant as [$i] $user_id / $user_pwd\n";
+	return ($user_id,$user_pwd);
+}
+
+sub ant_another_passwd {
+	my $ant = shift || die "no ant?";
+	$ant_passwd_try->{$ant}++;
+	$ant_passwd_try->{$ant} = 0 if ( $ant_passwd_try->{$ant} > $#try_accounts );
 }
 
 local $SIG{ALRM} = sub {
-	mdap_send("ANT-SEARCH MDAP/1.1\r\n46");
+	mdap_send("ANT-SEARCH MDAP/1.1\r\n");
 	alarm( $resend_search_delay );
 };
 
 alarm( $resend_search_delay );
 
+mdap_send("ANT-SEARCH MDAP/1.1\r\n");
+
 while (1) {
 	my $data;
 	next unless $sock->recv($data,1024);
 
-	if ( $data =~ m#^(REPLY-\S+)\s(MDAP/\d+\.\d+)# ) {
+	if ( $data =~ m#^(INFO|ANT-SEARCH|EXEC-CLI|REPLY-\S+)\s(MDAP)/(\d+\.\d+)# ) {
 
-		my ($type,$proto) = ($1,$2);
+		my ($type,$proto,$mdap_ver) = ($1,$2,$3);
 
 		my $h = ant2hash($data);
 
-		print "# $type $proto ", dump( $h ), $/;
+		my $client_version = $h->{'MDAP-VERSION'};
+		$mdap_ver = $client_version if ($client_version);
+
+		print "<< $type $proto/$mdap_ver << ", length($data), " bytes\n";
+
+		warn dump($h),$/ if ($debug);
+
+		# we are getting our own messages (since our source port
+		# is same as destination)
+		next if ( $type =~ m#^(INFO|ANT-SEARCH|EXEC-CLI)# );
+
+		my $ant = $h->{'ANT-ID'} || die "no ANT-ID in ", dump( $h );
+
+		my ($user_id,$user_pwd) = ant_credentials( $ant );
 
 		if ($type eq 'REPLY-ANT-SEARCH') {
-			mdap_send("INFO MDAP/1.2
-SEQ-NR:1
-TO-ANT:0644JTHJ4
-USER-ID:Administrator
-USER-PWD:\r\n22");
+			mdap_send("INFO MDAP/$mdap_ver\r\nSEQ-NR:1\r\nTO-ANT:$ant\r\nUSER-ID:$user_id\r\nUSER-PWD:$user_pwd\r\n");
 		} 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
-CLI-CMD:software upgrade
-SEQ-NR:1
-TO-ANT:0644JTHJ4
-USER-ID:Administrator
-USER-PWD:\r\n1F");
-			} else {
 
+			if ($h->{'SEQ-NR'} < 0) {
+				warn "!! password protected ant $ant, skipping\n";
+				ant_another_passwd( $ant );
+				next;
 			}
 
-			
+			my $board = $h->{'_BOARD_NAME'} || die "no _BOARD_NAME?";
+			if ( fw_exists( $board ) ) {
+				my $build = $h->{'_BUILD'} || die "no _BUILD?";
+				my $new_build = fw_build( $board );
+				if ( $build ne $new_build ) {
+					print "UPDATE STEP 1 on ant $ant version $build -> $new_build\n";
+					mdap_send("EXEC-CLI MDAP/$mdap_ver\r\nCLI-CMD:software upgrade\r\nSEQ-NR:1\r\nTO-ANT:$ant\r\nUSER-ID:$user_id\r\nUSER-PWD:$user_pwd\r\n");
+				} else {
+					print "OK ant $ant allready updated...\n";
+				}
+			} else {
+				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/$mdap_ver\r\nSEQ-NR:2\r\nTO-ANT:$ant\r\nUSER-ID:$user_id\r\nUSER-PWD:$user_pwd\r\n");
 		} else {
-			print "!! reply ignored\n";
+			print "!! reply ignored ", dump( $h ), $/;
 		}
 
 	} else {
-		print $data, "\n", "-" x 30, "\n";
+		warn "<=" x 15, "\n", $data, "\n", "<=" x 15, "\n";
 	}
 }