source: EcnlProtoTool/trunk/asp3_dcre/kernel/genoffset.trb

# -*- coding: utf-8 -*-
#
#   TOPPERS Software
#       Toyohashi Open Platform for Embedded Real-Time Systems
# 
#   Copyright (C) 2011-2018 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$
# 

#
#               オフセットファイル生成用の生成スクリプト
#

#
#  タイムスタンプファイルの指定
#
$timeStampFileName = "offset.timestamp"

#
#  offset.hの先頭部分の生成
#
$offsetH = GenFile.new("offset.h")
$offsetH.add2("/* offset.h */")

#
#  ビットのサーチ
#
def SearchBit(val)
  (0..7).each do |valBit|
    if (val & 1) != 0
      return valBit
    end
    val >>= 1
  end
end

#
#  ビットフィールドのオフセットとビット位置の算出
#
def BitOffsetPosition(label, structSize, outputSize)
  top = SYMBOL(label)
  if top.nil?
    error_exit("label `#{label}' not found")
  else
    val = 0
    offset = 0
    0.upto(structSize - 1).each do |i|
      tmpVal = PEEK(top + i, 1)
      if tmpVal != 0
        val = tmpVal
        offset = i
        break
      end
    end

    if val == 0
      error_exit("bit not found in `#{label}'")
    else
      position = SearchBit(val)
      case outputSize
      when 4, "W"
        if $endianLittle
          position = position + ((offset & 0x03) << 3)
        else
          position = position + 24 - ((offset & 0x03) << 3)
        end
        offset &= ~0x03
      when 2, "H"
        if $endianLittle
          position = position + ((offset & 0x01) << 3)
        else
          position = position + 8 - ((offset & 0x01) << 3)
        end
        offset &= ~0x01
      end
    end
    return offset, position
  end
end

# 以下の定義は，過去のバージョンとの互換性のために残している．

#
#  #defineディレクティブの生成
#
def GenerateDefine(symbol, value)
  $offsetH.add("#define #{symbol}\t#{value}")
end

#
#  ビットフィールドのオフセットとビット位置の定義の生成
#
def GenerateDefineBit(label, structSize, outputSize)
  offset, position = BitOffsetPosition(label, structSize, outputSize)
  if !offset.nil?
    GenerateDefine(label, offset)
    GenerateDefine("#{label}_bit", position)
    GenerateDefine("#{label}_mask", sprintf("0x%x", 1 << position))
  end
end