git.rot13.org Git - x300-pci/blob - openocd-jtag-boundary-scan.pl

   1 #!/usr/bin/perl
   2
   3 use warnings;
   4 use strict;
   5 use autodie;
   6 use Data::Dump qw(dump);
   7 use IO::Socket::INET;
   8
   9 my $bit2pin;
  10 my $io2bit;
  11
  12 my $pin2io;
  13 my $in_pin_map = 0;
  14 my $pin_map = '';
  15
  16
  17 open(my $bsdl, '<', '_3128at100.bsd');
  18 while(<$bsdl>) {
  19         if ( m/PIN_MAP_STRING/ ) {
  20                 $pin_map .= $_;
  21                 $in_pin_map = 1;
  22         } elsif ( $in_pin_map ) {
  23                 next if m/^\s*--/;
  24                 $pin_map .= $_;
  25                 $in_pin_map = 0 if m/;/;
  26         } elsif ( m/"(\d+)\s+\(BC_\d+,\s+(\S+),\s+(\S+)/ ) {
  27                 $bit2pin->{$1} = [ $2, $3 ];
  28                 push @{ $io2bit->{$2} }, $1;
  29         }
  30 }
  31 close($bsdl);
  32
  33 warn "# bit2pin = ",dump($bit2pin);
  34 warn "# io2bit = ",dump($io2bit);
  35
  36 $pin_map =~ s/"\s*\&\s*"/ /gs;
  37 $pin_map =~ s/^.*?:=\s*"//;
  38 $pin_map =~ s/"\s*;\s*$//s;
  39
  40 sub str_comma {
  41         my $t = shift;
  42         $t =~ s/\s*,\s*/ /gs;
  43         return $t;
  44 }
  45 warn "# pin_map = ",dump($pin_map);
  46 $pin_map =~ s/\(\s*([^\)]+?)\s*\)/str_comma($1)/gse;
  47 warn "# pin_map = ",dump($pin_map);
  48
  49 foreach my $map ( split(/\s*,\s*/, $pin_map) ) {
  50         warn "## $map\n";
  51         my ( $name, $pin ) = split(/\s*:\s*/, $map);
  52         $pin2io->[$_] = $name foreach split(/ /,$pin);
  53 }
  54
  55 warn "# pin2io = ",dump( $pin2io );
  56
  57 my @sort = sort {
  58         my $aa = $a; $aa =~ s/\D+//g;
  59         my $bb = $b; $bb =~ s/\D+//g;
  60         $aa <=> $bb } keys %$io2bit;
  61 warn "# sort = ",dump(@sort);
  62
  63 sub print_io {
  64         my $bits = shift;
  65         my $i = 0;
  66 #       foreach my $io ( @sort ) {
  67         print "pin off io___ I C O | " x 4, "\n";
  68         foreach my $i ( 0 .. ($#$pin2io/4)-1 ) {
  69                 foreach my $j ( 0 .. 3 ) {
  70                         #my $pin = ($i*4) + $j + 1; # rows
  71                         my $pin = ($#$pin2io/4) * $j + $i + 1; # columns
  72                         my $io = $pin2io->[$pin];
  73                         my $o = $io2bit->{$io}->[0];
  74                         if ( defined $o ) {
  75                                 printf "%-3d %-3d %-5s %d %d %d | ", $pin, $o, $io, split(//, substr($bits, $o, 3));
  76                         } else {
  77                                 printf "%-3d ... %-5s       | ", $pin, $io;
  78                         }
  79                 }
  80                 print "\n";
  81         }
  82         print "\n";
  83 }
  84
  85 #foreach my $h (qw(0 1 2 e f 10 11 12 1e 1f 20 30 40 50 100 200 1000)) {
  86 #        printf "hex = %4s  binary = %16s\n", $h, hex2bin($h);
  87 #}
  88
  89 my $sock = IO::Socket::INET->new('picam:4444');
  90
  91 sub hex2bin {
  92         my $h = shift;
  93         my $hlen = length($h);
  94         my $blen = $hlen * 4;
  95         return unpack("B$blen", pack("H$hlen", $h));
  96 }
  97
  98 sub bin2hex {
  99         my $b = shift;
 100         my $blen = length($b);
 101         my $hlen = $blen / 4;
 102         return unpack("H$hlen", pack("B$blen", $b));
 103 }
 104
 105 #my $cmd;
 106
 107 my $BSR;
 108
 109 # first sample
 110 print $sock "irscan x300.tap 0x55\n"; # SAMPLE/PRELOAD
 111 print $sock "drscan x300.tap 288 0\n";
 112
 113 while(1) {
 114
 115 while (<$sock>) {
 116         warn "<< ",dump($_);
 117         chomp;
 118         s/[\r\x00]+//g;
 119         if ( /^\s*([A-F0-9]+)/ ) {
 120                 my $hex = $1;
 121                 my $bin = hex2bin($hex);
 122                 $BSR = $bin;
 123                 print_io $bin;
 124                 last;
 125         } else {
 126                 warn "# in ",dump($_);
 127         }
 128 }
 129
 130 sub diff_bits {
 131         my ($old, $new) = @_;
 132         $old =~ s/(...)/$1 /g;
 133         $new =~ s/(...)/$1 /g;
 134         my @o = split(/ /, $old);
 135         my @n = split(/ /, $new);
 136         foreach my $i ( 0 .. $#o ) {
 137                 if ( $o[$i] eq $n[$i] ) {
 138                         $o[$i]='.';
 139                 } else {
 140                         $o[$i].='>'.$n[$i];
 141                 }
 142         }
 143         return join('', @o);
 144 }
 145
 146 print "[press enter]\n";
 147 my $cmd = <STDIN>;
 148 chomp $cmd;
 149 if ( $cmd =~ /(\d+)=(\d)/ ) {
 150         my ( $pin, $v ) = ( $1, $2 );
 151         warn "# pin $pin = $v\n";
 152
 153         my $io = $pin2io->[$pin];
 154         my $bit = $io2bit->{$io}->[0];
 155
 156         my $b = substr($BSR,0,$bit+1)
 157                 . ( substr($BSR,$bit+1,1) ^ 1 )
 158                 . ( $v & 1 )
 159                 . substr($BSR,$bit+3)
 160                 ;
 161
 162         print diff_bits( $BSR, $b ), $/;
 163
 164         print $sock "irscan x300.tap 0x00\n"; # EXTEST
 165         print $sock "drscan x300.tap 288 0x", bin2hex($b), "\n";
 166 } else {
 167         print $sock "irscan x300.tap 0x55\n"; # SAMPLE/PRELOAD
 168         print $sock "drscan x300.tap 288 0\n";
 169 }
 170
 171
 172 }#while(1)