source: mypx/utils/genoffset

#! /usr/bin/perl
#
#  TOPPERS Software
#      Toyohashi Open Platform for Embedded Real-Time Systems
# 
#  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
#                              Toyohashi Univ. of Technology, JAPAN
#  Copyright (C) 2004-2011 by Embedded and Real-Time Systems Laboratory
#              Graduate School of Information Science, Nagoya Univ., JAPAN
# 
#  Ÿåµ­Ãøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§
#  ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ
#  ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥
#  (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ­€ÎÃøºî
#      ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ
#      ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥
#  (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
#      Íрǀ­€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍÑ
#      ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­
#      €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
#  (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
#      Íрǀ­€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³
#      €È¡¥
#    (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃø
#        ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
#    (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë
#        Êó¹ð€¹€ë€³€È¡¥
#  (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë»
#      ³²€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥
#      €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý
#      ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò
#      ÌÈÀÕ€¹€ë€³€È¡¥
# 
#  ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄ󶡀µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥Ÿåµ­Ãøºîž¢ŒÔ€ª
#  €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ
#  €ËÂЀ¹€ëŬ¹çÀ­€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§
#  ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ
#  €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥
# 
#  @(#) $Id$
# 

#
#  œéŽü²œ
#
$infile = $ARGV[0];
$sil_endian = "";

#
#  ²òŒá€Ç€­€ë¥Ç¥£¥ì¥¯¥Æ¥£¥Ö€Î¥Æ¡Œ¥Ö¥ë
#
%directives = (
        "long", "",
        "dword", "",
        "word", "",
        "hword", "",
        "int", "",
        "short", "",
        "half", "",
        "byte", "",
        "value", "",
        "uaword", "",
        "uashort", "",
        "data32", 4,
        "data16", 2,
        "data8", 1,
        "zero", -1,
        "space", -1,
        "globl", 0,
        "global", 0,
        "align", 0,
        "p2align", 0,
        "even", 0,
        "data", 0,
        "stabs", 0,
        "type", 0,
        "size", 0,
        "section", 0,
        "sdata", 0,
        "code", 0,
);

#
#  ¥ª¥Õ¥»¥Ã¥ÈÃ̀ΜÐÎÏ
#
sub parse_offset {
        my($label, $val) = @_;

        printf "#define %s\t%d\n",$label,$val;
}

#
#  ¥Ç¥£¥ì¥¯¥Æ¥£¥Ö€ÎÆɀߌè€ê
#
sub ref_bit {
        my($size) = @_;
        my($dir, $directive);

        while ($line = <INFILE>) {
                chomp $line;
                next if ($line =~ /^[ \t]*[#;].*$/);

                if ($line =~ /[ \t]*\.([a-zA-Z0-9]+)[ \t]*([^ \t]*)[ \t]*/
                                                && defined($dir = $directives{$1})) {
                        $directive = $1;
                        if ($dir eq "") {
                                # ÅÐÏ¿€¹€Ù€­¥Ç¥£¥ì¥¯¥Æ¥£¥Ö
                                $directives{$directive} = $size;
                        }
                        last;
                }
                else {
                        # ²òÀπǀ­€Ê€€¹Ô
                        print STDERR "genoffset: cannot parse: $line\n";
                        $error = 1;
                }
        }
}

#
#  ¥Ó¥Ã¥È¥µ¡Œ¥Á
#
sub search_bit {
        my($val) = @_;
        my($val_bit);

        return(-1) if ($val == 0);

        $val_bit = 0;
        while (($val & 1) == 0) {
                $val >>= 1;
                $val_bit++;
        }
        return($val_bit);
}

#
#  ¥Ó¥Ã¥È°ÌÃրΜÐÎÏ
#
sub parse_bit {
        my($endian, $size, $label) = @_;
        my($offset, $dir, $val, $val_bit);

        if ($sil_endian && $endian ne $sil_endian) {
                # ¥š¥ó¥Ç¥£¥¢¥ó€ÎÉÔ°ìÃ×
                print STDERR "genoffset: endian mismatch: $line\n";
                $error = 1;
        }

        $offset = 0;
        while ($line = <INFILE>) {
                chomp $line;
                next if ($line =~ /^[ \t]*[#;].*$/);

                if ($line =~ /[ \t]*\.([a-zA-Z0-9]+)[ \t]*([^ \t]*)[ \t]*/
                                                && defined($dir = $directives{$1})) {
                        $val = $2;

                        # 16¿Ê¿ô€È8¿Ê¿ô€Î¿ôÃ̀؀ÎÊÑŽ¹œèÍý
                        if ($val =~ /^0x(.+)$/) {
                                $val = hex($1);
                        }
                        elsif ($val =~ /^0(.+)$/) {
                                $val = oct($1);
                        }

                        if ($dir eq "") {
                                # ¥µ¥€¥º€òÃ΀é€Ê€€¥Ç¥£¥ì¥¯¥Æ¥£¥Ö
                                print STDERR "genoffset: unknown directive: $line\n";
                                $error = 1;
                        }
                        elsif ($dir == 0) {
                                # ÆÉ€ßÈô€Ð€¹€Ù€­¥Ç¥£¥ì¥¯¥Æ¥£¥Ö
                        }
                        elsif ($dir == -1) {
                                # .zero¥Ç¥£¥ì¥¯¥Æ¥£¥Ö€ÎœèÍý
                                $offset += $val;
                        }
                        elsif ($val == 0) {
                                # ÃÍ€¬0€Î¥Õ¥£¡Œ¥ë¥É€ÎœèÍý
                                $offset += $dir;
                        }
                        else {
                                # ÃÍ€¬0€Ç€Ê€€¥Õ¥£¡Œ¥ë¥É€¬ž«€Ä€«€ì€Ð¥ë¡Œ¥×€òœªÎ»
                                last;
                        }
                }
                else {
                        # ²òÀπǀ­€Ê€€¹Ô
                        print STDERR "genoffset: cannot parse: $line\n";
                        $error = 1;
                }
        }

        # ¥Ó¥Ã¥È°ÌÃÖ€òõ€¹
        $val_bit = search_bit($val);

        # ¥Ð¥€¥Èñ°Ì€ËŽ¹»»€¹€ë
        if ($endian eq "B") {
                $offset += $dir - 1;
                $offset -= $val_bit >> 3;
        }
        else {
                $offset += $val_bit >> 3;
        }
        $val_bit &= 0x07;

        # œÐÎÏñ°Ì€ËŽ¹»»€¹€ë
        if ($size eq "W") {
                if ($endian eq "B") {
                        $val_bit += 24;
                        $val_bit -= ($offset & 0x03) << 3;
                }
                else {
                        $val_bit += ($offset & 0x03) << 3;
                }
                $offset &= ~0x03;
        }
        elsif ($size eq "H") {
                if ($endian eq "B") {
                        $val_bit += 8;
                        $val_bit -= ($offset & 0x01) << 3;
                }
                else {
                        $val_bit += ($offset & 0x01) << 3;
                }
                $offset &= ~0x01;
        }

        # ÄêµÁ€ÎœÐÎÏ
        $label =~ s/^_//;
        printf "#define %s\t%d\n",$label,$offset;
        printf "#define %s_bit\t%d\n",$label,$val_bit;
        printf "#define %s_mask\t0x%x\n",$label,(1 << $val_bit);
}

#
#  ¥á¥€¥ó¥ë¡Œ¥Á¥ó
#
print "/* This file is generated by genoffset. */\n";
print "\n";

$error = 0;
open(INFILE, $infile) || die "Cannot open $infile";
while ($line = <INFILE>) {
        chomp $line;

        if ($line =~ /^[ \t]*OFFSET_DEF ([^ \t]+) = [#\$]?([^ \t]+)/) {
                parse_offset($1, $2);
        }
        elsif ($line =~ /^[ \t]*_?BIT_REF_([0-9]+):/) {
                ref_bit($1);
        }
        elsif ($line =~ /^[ \t]*SIL_ENDIAN = ([BL])/) {
                $sil_endian = $1;
        }
}
#
#  ¥³¥ó¥Ñ¥€¥é€¬¥°¥í¡Œ¥Ð¥ëÊÑ¿ô€ÎÇÛÃÖœçœø€òÊѹ¹€¹€ë€È¡€BIT_REF_?€¬²Œ€Ë€Ê
#  €ë²ÄÇœÀ­€¬€¢€ë€¿€á¡€Æ¬€«€éÆÉ€ßÄŸ€¹¡¥
#
seek(INFILE, 0, SEEK_SET);
while ($line = <INFILE>) {
        chomp $line;

        if ($line =~ /^[ \t]*_?BIT_([BL])([BHW])_([^ \t]+):/) {
                parse_bit($1, $2, $3);
        }
}
close(INFILE);
exit($error);