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