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