tinyriscv-openocd/tools/st7_dtc_as/st7_dtc_as.pl

710 lines
13 KiB
Perl
Raw Normal View History

#!/bin/perl
#***************************************************************************
#* Copyright (C) 2008 Lou Deluxe *
#* lou.openocd012@fixit.nospammail.net *
#* *
#* This program is free software; you can redistribute it and/or modify *
#* it under the terms of the GNU General Public License as published by *
#* the Free Software Foundation; either version 2 of the License, or *
#* (at your option) any later version. *
#* *
#* This program is distributed in the hope that it will be useful, *
#* but WITHOUT ANY WARRANTY; without even the implied warranty of *
#* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
#* GNU General Public License for more details. *
#* *
#* You should have received a copy of the GNU General Public License *
#* along with this program; if not, write to the *
#* Free Software Foundation, Inc., *
#* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
#***************************************************************************
# A rudimentary assembler for DTC code.
# It is not robust, by any means, but it gets the job done.
{package DTC_as;
my($i); # for later loop to generate reverse lookup
sub new {
my($self) = bless{};
$self->{'pagewidth'} = 60;
$self;
}
%status_bit_arg = (
'STOP' => 0x01,
'ERROR' => 0x02,
);
%cp_arg = (
'A=>X' => 0x00,
'A<X' => 0x01,
'CARRY' => 0x02,
'ALWAYS' => 0x03,
'ADR_BUFFER0=>CMP0' => 0x04,
'ADR_BUFFER0<CMP0' => 0x05,
'ADR_BUFFER1=>CMP1' => 0x06,
'ADR_BUFFER1<CMP1' => 0x07,
);
%shift_unit_arg = (
'CARD' => 0x00,
'MPEG' => 0x08,
);
%shift_pin_arg = (
'PIN0=>IN' => 0x00,
'PIN1=>IN' => 0x04,
'OUT=>PIN0' => 0x01,
'OUT=>PIN1' => 0x03,
);
@ld_arg = (
'<Y>',
'X',
'Y',
'MASK',
'ADR_BUFFER00',
'ADR_BUFFER01',
'ADR_BUFFER10',
'ADR_BUFFER11',
'CMP00',
'CMP01',
'CMP10',
'CMP11',
'DATA_FLASH',
'CTRL_FCI',
'CTRL_CARD',
'CTRL_MPEG',
'DR_PARALLEL',
'DDR_PARALLEL',
'OR_PARALLEL',
'DR_CARD',
'DDR_CARD',
'OR_CARD',
'SHIFT_CARD',
'DR_MPEG',
'DDR_MPEG',
'OR_MPEG',
'SHIFT_MPEG',
'DATA_BUFFER0',
'DATA_BUFFER1',
'ECC_CRC',
'TMP_ECC',
'BUFFER_MNGT'
);
for($i = 0; $i < @ld_arg; $i++) {
$ld_arg{$ld_arg[$i]} = $i;
}
# ADDER8 / SUB8
sub alu8 {
my($self) = shift;
my($operand, $i) = shift;
if(defined($ld_arg{$operand})) {
$i = $ld_arg{$operand};
if($i > 0x00 && $i < 0x04) {
return(($i - 0x01) << 3);
}
}
return undef;
}
# ADDER16 / SUB16
sub alu16 {
my($self) = shift;
my($operand, $i) = shift;
$operand .= '0';
if(defined($ld_arg{$operand})) {
$i = $ld_arg{$operand};
if($i > 0x03 && $i < 0x0c) {
return(($i - 0x04) << 2);
}
}
return undef;
}
# BSET / BCLR
sub bsetorclr {
my($self) = shift;
my($ret);
if(@_ < 1) {
return undef;
}
$ret = $_[0];
if(($ret < 0) || ($ret > 3)) {
return undef;
}
return $ret;
}
# Opcode lookup table
%op = (
'NOP' => [
0x0,
],
'SEC' => [
0x1,
],
'CLC' => [
0x2,
],
'RET' => [
0x3,
],
'STATUS' => [
0x4,
sub {
my($self) = shift;
my($ret, $i);
for $i (@_) {
if(!defined($status_bit_arg{"\U$i"})) {
return undef;
}
$ret |= $status_bit_arg{"\U$i"};
}
if($ret < 1) {
return undef;
}
return $ret;
}
],
'CP' => [
0x8,
sub {
my($self) = shift;
if((@_ != 1) || (!defined($cp_arg{"\U$_[0]"}))) {
return undef;
}
return($cp_arg{"\U$_[0]"});
}
],
'SHIFT' => [
0x10,
sub {
my($self) = shift;
my($ret, $i);
if((@_ < 2) || (!defined($shift_unit_arg{"\U$_[0]"}))) {
return undef;
}
$ret = $shift_unit_arg{"\U$_[0]"};
shift;
for $i (@_) {
if(!defined($shift_pin_arg{"\U$i"})) {
return undef;
}
$ret |= $shift_pin_arg{"\U$i"};
}
return $ret;
}
],
'SUB8' => [
0x24,
\&alu8
],
'ADDER8' => [
0x25,
\&alu8
],
'SUB16' => [
0x26,
\&alu16
],
'ADDER16' => [
0x27,
\&alu16
],
'BCLR' => [
0x28,
\&bsetorclr
],
'BSET' => [
0x38,
\&bsetorclr
],
'REVERSE' => [
0x30,
],
'XOR' => [
0x31,
],
'AND' => [
0x32,
],
'EXCHANGE' => [
0x33,
],
'DECY' => [
0x3c,
],
'INCY' => [
0x3d,
],
'JP' => [
0x40,
sub {
my($self) = shift;
my($i);
if(@_ != 1) {
return undef;
}
$i = $_[0];
if(!defined($self->{'label'}{$i})) {
$i =~ s/^://o;
if(!defined($self->{'label'}{$i})) {
# not a defined label
undef $i;
}
}
if(defined($i)) {
$i = $self->{'label'}{$i} - $self->{'pc'};
} else {
$i = $_[0];
}
if($i =~ m/^([+-]?\d+)$/) {
$i = 0 + $1;
if(($i > 31) || ($i < -31)) {
warn "relative jump ($i) out of range";
return undef;
}
if($i < 0) {
return(0x20 - $1);
} else {
return(0x00 + $1);
}
}
return undef;
}
],
'BRANCH' => [
0x60,
],
'LD' => [
0x80,
sub {
my($self) = shift;
my($i);
# print STDERR join(", ", LD, @_), "\n";
if(@_ == 1) {
$_[1] = 'A';
}
if(@_ != 2) {
return undef;
}
if($_[0] =~ m/^([ML])S[BN]$/o) {
# MSB/LSB aka MSN/LSN
if($1 eq 'L') {
$_[0] = 'A.L';
} else {
$_[0] = 'A.H';
}
}
if($_[0] =~ m/^A\.([LH])$/o) {
# A.L/A.H
my($islsb) = ($1 eq 'L') ? 1 : 0;
$i = $_[1];
if($i =~ s/^0x([0-9a-fA-F])$/hex($1)/e) {
# print "$i looks hex\n";
} elsif($i =~ m/^\d+$/) {
# print "$i looks decimal\n";
} elsif(defined($self->{'label'}{$i})) {
# print "label match for $i ($self->{'label'}{$i})\n";
$i = $self->{'label'}{$i};
# print "\$i=$i\n";
# print "\$islsb=$islsb\n";
if($islsb) {
$i = ($i & 0xf);
} else {
$i = ($i >> 4) & 0xf;
}
# print "\$i=$i\n";
} else {
print "no label match for $i\n";
return undef;
}
if(($i < 0) || ($i > 0xf)) {
return undef;
}
if($islsb) {
$i |= 0x10;
};
return(0x20 | $i);
} elsif($_[0] eq 'A') {
if(!defined($ld_arg{$_[1]})) {
return undef;
}
return(0x40 | $ld_arg{$_[1]});
} elsif($_[1] eq 'A') {
if(!defined($ld_arg{$_[0]})) {
return undef;
}
return(0x00 | $ld_arg{$_[0]});
}
return undef;
}
],
);
$op{'JR'} = $op{'JP'};
sub pass {
my($self, $ifh, $ofh, $passnum) = @_;
# passnum=0 for plain parsing pass to populate label values
# passnum=1 for actual pass to assemble
my($line, $oline, $opcd);
if($passnum == 0) {
delete($self->{'label'});
delete($self->{'binary'});
delete($self->{'ENTRY'});
delete($self->{'LUT'});
}
seek($ifh, 0, 0); # rewind
$self->{'pc'} = 0;
$self->{'line_number'} = 0;
while(defined($line = <$ifh>)) {
$self->{'line_number'}++;
$line =~ s/\s+$//so;
$oline = $line;
$line =~ s/;.*//o;
$line =~ s/^\s+//o;
@_ = split(/[\s,]+/, $line);
undef($opcd);
if(@_ > 0) {
if(
($_[0] =~ s/^://o)
||
($_[0] =~ s/:$//o)
) {
if($passnum == 0) {
if(defined($self->{'label'}{$_[0]})) {
die "label redefinition for \"$_[0]\" in line $self->{'line_number'}";
}
$self->{'label'}{$_[0]} = $self->{'pc'};
}
shift(@_);
}
if(@_ > 0) {
if($passnum == 1) {
if((@_ == 3) && ($_[1] eq '=')) {
# convert this = that to LD
$_[1] = $_[0];
$_[0] = 'LD';
}
elsif((@_ == 3) && ($_[1] eq '+=')) {
# convert this += that to ADDER8 or ADDER16
if($_[0] eq 'A') {
@_ = ('ADDER8', $_[2]);
}
elsif($_[2] eq 'X') {
@_ = ('ADDER16', $_[0]);
}
}
elsif((@_ == 3) && ($_[1] eq '-=')) {
# convert this -= that to ADDER8 or ADDER16
if($_[0] eq 'A') {
@_ = ('SUB8', $_[2]);
}
elsif($_[2] eq 'X') {
@_ = ('SUB16', $_[0]);
}
}
elsif((@_ == 1) && ($_[0] =~ m/^(B((SET)|(CLR)))([1-4])$/oi)) {
# convert BSETn or BCLRn to BSET n-1 or BCLR n-1
$_[0] = $1;
$_[1] = $5 - 1;
}
$op = "\U$_[0]";
if(!defined($op{$op})) {
die "unknown instruction: $op in line $self->{'line_number'}";
}
shift(@_);
$op = $op{$op};
$sub = $op->[1];
if(defined($sub)) {
$opcd = &$sub($self, @_);
} else {
$opcd = 0;
}
if(!defined($opcd)) {
die "bad argument(s) in line $self->{'line_number'}";
}
$opcd |= $op->[0];
}
$self->{'pc'}++;
}
} else {
if($passnum == 0) {
if($oline =~ m/^;LUT; (.*)/o) {
my($entry, $label) = split(/\s+/, $1);
$entry =~ s/^0x//o;
$self->{'LUT'}[hex($entry)] = $label;
}
if($oline =~ m/^;ENTRY; (.*)/o) {
my($id, $label) = split(/\s+/, $1);
$self->{'ENTRY'}{$id} = $label;
}
}
}
if($passnum == 1) {
if(defined($opcd)) {
$self->{'binary'} .= chr($opcd);
printf $ofh ("/* 0x%02x */ 0x%02x%s /* %-*s */\n",
$self->{'pc'} - 1,
$opcd,
(
(
($self->{'last pc'} < 0xff)
||
($self->{'last pc'} != $self->{'pc'} - 1)
) ?
','
:
''
),
$self->{'pagewidth'} - 23,
$oline
);
} else {
if($oline ne '') {
print $ofh " /* $oline */\n";
} else {
print $ofh "\n";
}
}
}
}
if($passnum == 0) {
$self->{'last pc'} = $self->{'pc'} - 1;
}
if($passnum == 1) {
while($self->{'pc'} < 0xff) {
printf $ofh ("/* 0x%02x */ 0,\n",
$self->{'pc'}
);
$self->{'pc'}++;
}
if($self->{'pc'} < 0x100) {
printf $ofh ("/* 0x%02x */ 0\n",
$self->{'pc'}
);
$self->{'pc'}++;
}
}
}
} # package DTC_as
use Getopt::Std;
%opt = (
't' => 'unsigned char',
);
# -t type of arrays (defaults to unsigned char)
# -l lookup table array name (no table generated if not provided)
# -d DTC code array name (naked elements if not provided)
# -i input filename (trailing argument if not provided)
# -o output filename (stdout if not provided)
getopts('l:d:i:o:t:b', \%opt);
if(defined($opt{'i'})) {
$infile = $opt{'i'};
} else {
$infile = shift;
}
if(!open(IN, '<', $infile)) {
die "$infile: $!";
}
if($opt{'b'}) {
if(!defined($opt{'o'})) {
die "binary format requires -o";
}
if(!open(OUT, '>&', *STDOUT)) {
die "dup stdout: $!";
}
open(STDOUT, '>&', *STDERR);
} else {
if(defined($opt{'o'})) {
if(!open(OUT, '>', $opt{'o'})) {
die "$opt{'o'}: $!";
}
} else {
if(!open(OUT, '>&', *STDOUT)) {
die "dup stdout: $!";
}
open(STDOUT, '>&', *STDERR);
}
}
$as = new DTC_as;
$as->pass(*IN, *OUT, 0);
if(defined($opt{'d'})) {
print OUT "$opt{'t'} $opt{'d'}", "[0x100] = {\n";
}
$as->pass(*IN, *OUT, 1);
if(defined($opt{'d'})) {
print OUT "};\n\n";
}
close(IN);
if(defined($opt{'l'})) {
print OUT "$opt{'t'} $opt{'l'}", "[0x40] = {\n";
# $end = @{$as->{'LUT'}};
# if($end > 0x100) {
# $end = 0x100;
# }
for($i = 0xc0; $i < 0x100; $i++) {
$label = $as->{'LUT'}[$i];
if(defined($label)) {
if(defined($as->{'label'}{$label})) {
printf OUT ("/* 0x%02x */ 0x%02x%s /* %s */\n",
$i,
$as->{'label'}{$label},
(($i < 0xff) ? ',' : ''),
$label
);
} else {
die "label $label has not been defined";
}
} else {
printf OUT ("/* 0x%02x */ 0%s\n",
$i,
(($i < 0xff) ? ',' : ''),
);
}
}
print OUT "};\n\n";
}
close(OUT);
sub DTCLOAD_COMMENT { 0; }
sub DTCLOAD_ENTRY { 1; }
sub DTCLOAD_LOAD { 2; }
sub DTCLOAD_RUN { 3; }
sub DTCLOAD_LUT_START { 4; }
sub DTCLOAD_LUT { 5; }
if($opt{'b'}) {
open(OUT, ">", $opt{'o'}) || die "$opt{'o'}: $!";
syswrite(OUT, pack('CC', DTCLOAD_LUT_COMMENT, 3 - 1) . 'DTC');
$ref = $as->{'LUT'};
if(@$ref > 0) {
for($start = 0; $start < @$ref && !defined($ref->[$start]); $start++) {}
for($end = 0xff; $end >= $start && !defined($ref->[$end]); $end--) {}
undef($lut);
for($i = $start; $i <= $end; $i++) {
if(!defined($ref->[$i])) {
$lut .= "\0";
next;
}
$label = $ref->[$i];
if(defined($as->{'label'}{$label})) {
$label = $as->{'label'}{$label};
# printf("adding LUT entry 0x%02x\n", $label);
$lut .= chr($label);
} else {
die "label $label has not been defined";
}
}
if(length($lut) > 0) {
syswrite(OUT, pack('CCC', DTCLOAD_LUT_START, 1 - 1, $start));
syswrite(OUT, pack('CC', DTCLOAD_LUT, length($lut) - 1) . $lut);
}
}
while(($key, $label) = each(%{$as->{'ENTRY'}})) {
# print "$key = $label\n";
if(defined($as->{'label'}{$label})) {
$label = $as->{'label'}{$label};
# print "key=$key\n";
# print "label=$label\n";
syswrite(OUT, pack('CCC', DTCLOAD_ENTRY, length($key), $label) . $key);
} else {
die "label $label has not been defined";
}
}
if(length($as->{'binary'})) {
# printf("DTC code size: 0x%x\n", length($as->{'binary'}));
syswrite(OUT, pack('CC',
DTCLOAD_LOAD ,
length($as->{'binary'}) - 1
) . $as->{'binary'});
if(%{$as->{'ENTRY'}} < 1) {
syswrite(OUT, pack('CCC', DTCLOAD_RUN, 1 - 1, 0x00));
}
}
close(OUT);
}
0;