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