source: asp3_wo_tecs/trunk/kernel/interrupt.trb@ 305

# -*- coding: utf-8 -*-
#
#   TOPPERS/ASP Kernel
#       Toyohashi Open Platform for Embedded Real-Time Systems/
#       Advanced Standard Profile Kernel
# 
#   Copyright (C) 2015 by FUJI SOFT INCORPORATED, JAPAN
#   Copyright (C) 2015,2016 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: interrupt.trb 612 2016-02-08 04:27:57Z ertl-hiro $
# 

#
#               割込み管理機能の生成スクリプト
#

#
#  kernel_cfg.hの生成
#
$kernelCfgH.add("#define TNUM_ISRID\t#{$cfgData[:CRE_ISR].size}")

$cfgData[:CRE_ISR].sort.each do |key, params|
  $kernelCfgH.add("#define #{params[:isrid]}\t#{params[:isrid].val}")
end
$kernelCfgH.add()

#
#  kernel_cfg.cの生成
#
$kernelCfgC.comment_header("Interrupt Management Functions")

#
#  トレースログマクロのデフォルト定義
#
$kernelCfgC.append(<<EOS)
#ifndef LOG_ISR_ENTER
#define LOG_ISR_ENTER(isrid)
#endif /* LOG_ISR_ENTER */

#ifndef LOG_ISR_LEAVE
#define LOG_ISR_LEAVE(isrid)
#endif /* LOG_ISR_LEAVE */

EOS

#
#  CRE_ISRで使用できる割込み番号とそれに対応する割込みハンドラ番号のデ
#  フォルト定義
#
if $INTNO_CREISR_VALID.nil?
  $INTNO_CREISR_VALID = $INTNO_VALID
end
if $INHNO_CREISR_VALID.nil?
  $INHNO_CREISR_VALID = $INHNO_VALID
end

#
#  CFG_INTで使用できる割込み優å…
ˆåº¦ã®ãƒ‡ãƒ•ã‚©ãƒ«ãƒˆå®šç¾©
# 
if $INTPRI_CFGINT_VALID.nil?
  $INTPRI_CFGINT_VALID = $TMIN_INTPRI.val.upto($TMAX_INTPRI.val).to_a
end

#
#  割込み番号と割込みハンドラ番号の変換テーブルの作成
#
if $INTNO_CREISR_VALID.length != $INHNO_CREISR_VALID.length
  error_exit("length of `INTNO_CREISR_VALID' is different from" \
                                                                        " length of `INHNO_CREISR_VALID'")
end
$toInhnoVal = {}
$toIntnoVal = {}
inhno_creisr_valid = $INHNO_CREISR_VALID.dup
$INTNO_CREISR_VALID.each do |intnoVal|
  inhnoVal = inhno_creisr_valid.shift
  $toInhnoVal[intnoVal] = inhnoVal
  $toIntnoVal[inhnoVal] = intnoVal
end

#
#  割込み要求ラインに関するエラーチェック
#
$cfgData[:CFG_INT].each do |key, params|
  #     intnoãŒå‰²è¾¼ã¿ç•ªå·ã¨ã—ã¦æ­£ã—ããªã„å ´åˆï¼ˆE_PAR）［NGKI2972ï¼½
  if $INTNO_VALID.index(params[:intno]).nil?
    error_illegal("E_PAR", params, :intno)
  end

  #     intatrãŒç„¡åŠ¹ã®å ´åˆï¼ˆE_RSATR）［NGKI2969ï¼½
  #（TA_ENAINT，TA_EDGE，TARGET_INTATRä»¥å¤–ã®ãƒ“ãƒƒãƒˆãŒã‚»ãƒƒãƒˆã•ã‚Œã¦ã„ã‚‹å ´åˆï¼‰
  if (params[:intatr] & ~($TA_ENAINT|$TA_EDGE|$TARGET_INTATR)) != 0
    error_illegal_sym("E_RSATR", params, :intatr, :intno)
  end

  #     intpriがCFG_INTに対する割込み優å…
ˆåº¦ã¨ã—ã¦æ­£ã—ããªã„å ´åˆï¼ˆE_PAR）
  #     ï¼»NGKI2973ï¼½
  if $INTPRI_CFGINT_VALID.index(params[:intpri]).nil?
    error_illegal_sym("E_OBJ", params, :intpri, :intno)
  end

  # カーネル管理外に固定されているintnoに対して，intpriにTMIN_INTPRIよ
  #     ã‚Šã‚‚å°ã•ã„å€¤ãŒæŒ‡å®šã•ã‚Œãªã‹ã£ãŸå ´åˆï¼ˆE_OBJ）［NGKI2983ï¼½
  if !$INTNO_FIX_NONKERNEL.nil?
    if !$INTNO_FIX_NONKERNEL.index(params[:intno]).nil?
      if params[:intpri] >= $TMIN_INTPRI
        error_ercd("E_OBJ", params, "intno `#{params[:intno]}'" \
                                                        " must have higher priority than TMIN_INTPRI")
      end
    end
  end

  #     カーネル管理に固定されているintnoに対して，intpriにTMIN_INTPRIより
  #     ã‚‚å°ã•ã„å€¤ãŒæŒ‡å®šã•ã‚ŒãŸå ´åˆï¼ˆE_OBJ）［NGKI2984ï¼½
  if !$INTNO_FIX_KERNEL.nil?
    if !$INTNO_FIX_KERNEL.index(params[:intno]).nil?
      if params[:intpri] < $TMIN_INTPRI
        error_ercd("E_OBJ", params, "intno `#{params[:intno]}'" \
                                        " must have lower or equal priority to TMIN_INTPRI")
      end
    end
  end
end

#
#  割込みハンドラに関するエラーチェック
#
$cfgData[:DEF_INH].each do |key, params|
  # inhnoãŒå‰²è¾¼ã¿ãƒãƒ³ãƒ‰ãƒ©ç•ªå·ã¨ã—ã¦æ­£ã—ããªã„å ´åˆï¼ˆE_PAR）［NGKI3055ï¼½
  if $INHNO_VALID.index(params[:inhno]).nil?
    error_illegal("E_PAR", params, :inhno)
  end

  # inhatrãŒç„¡åŠ¹ã®å ´åˆï¼ˆE_RSATR）［NGKI3052ï¼½
  #（TARGET_INHATRä»¥å¤–ã®ãƒ“ãƒƒãƒˆãŒã‚»ãƒƒãƒˆã•ã‚Œã¦ã„ã‚‹å ´åˆï¼‰
  if (params[:inhatr] & ~$TARGET_INHATR) != 0
    error_illegal_sym("E_RSATR", params, :inhatr, :inhno)
  end

  #     カーネル管理外に固定されているinhnoに対して，inhatrにTA_NONKERNELが
  #     æŒ‡å®šã•ã‚Œã¦ã„ãªã„å ´åˆï¼ˆE_RSATR）［NGKI3067ï¼½
  if !$INHNO_FIX_NONKERNEL.nil?
    if !$INHNO_FIX_NONKERNEL.index(params[:inhno]).nil?
      if (params[:inhatr] & $TA_NONKERNEL) == 0
        error_ercd("E_RSATR", params, "inhno `#{params[:inhno]}'" \
                                                                        " must be non-kernel interrupt")
      end
    end
  end

  #     カーネル管理に固定されているinhnoに対して，inhatrにTA_NONKERNELが指
  #     å®šã•ã‚Œã¦ã„ã‚‹å ´åˆï¼ˆE_RSATR）［NGKI3068ï¼½
  if !$INHNO_FIX_KERNEL.nil?
    if !$INHNO_FIX_KERNEL.index(params[:inhno]).nil?
      if (params[:inhatr] & $TA_NONKERNEL) != 0
        error_ercd("E_RSATR", params, "inhno `#{params[:inhno]}'" \
                                                                        " must not be non-kernel interrupt")
      end
    end
  end

  if $toIntnoVal.has_key?(params[:inhno].val)
    intnoVal = $toIntnoVal[params[:inhno].val]

    # inhnoに対応するintnoに対するCFG_INTãŒãªã„å ´åˆï¼ˆE_OBJ）［NGKI3062ï¼½
    if !$cfgData[:CFG_INT].has_key?(intnoVal)
      error_ercd("E_OBJ", params, "intno `#{intnoVal}' corresponding to" \
                                " inhno `#{params[:inhno]}' is not configured with CFG_INT")
    else
      intnoParams = $cfgData[:CFG_INT][intnoVal]
      if (params[:inhatr] & $TA_NONKERNEL) == 0
        # inhatrにTA_NONKERNELが指定されておらず，inhnoに対応するintno
        # に対してCFG_INTで設定された割込み優å…
ˆåº¦ãŒTMIN_INTPRIよりも小
        # ã•ã„å ´åˆï¼ˆE_OBJ）［NGKI3065ï¼½
        if intnoParams[:intpri] < $TMIN_INTPRI
          error_ercd("E_OBJ", params, "intpri `#{intnoParams[:intpri]}'" \
                                                " configured for inhno `#{params[:inhno]}' must" \
                                                " be lower or equal to TMIN_INTPRI")
        end
      else
        # inhatrにTA_NONKERNELが指定されており，inhnoに対応するintnoに
        # 対してCFG_INTで設定された割込み優å…
ˆåº¦ãŒTMIN_INTPRI以上である
        # å ´åˆï¼ˆE_OBJ）［NGKI3066ï¼½
        if intnoParams[:intpri] >= $TMIN_INTPRI
          error_ercd("E_OBJ", params, "intpri `#{intnoParams[:intpri]}'" \
                                                " configured for inhno `#{params[:inhno]}' must" \
                                                " be higher than with TMIN_INTPRI")
        end
      end
    end
  end
end

#
#  割込みサービスルーチン（ISR）に関するエラーチェックと割込みハンドラの生成
#
$cfgData[:CRE_ISR].sort.each do |key, params|
  #     isratrãŒç„¡åŠ¹ã®å ´åˆï¼ˆE_RSATR）［NGKI2998ï¼½
  #（TARGET_ISRATRä»¥å¤–ã®ãƒ“ãƒƒãƒˆãŒã‚»ãƒƒãƒˆã•ã‚Œã¦ã„ã‚‹å ´åˆï¼‰
  if (params[:isratr] & ~$TARGET_ISRATR) != 0
    error_illegal("E_RSATR", params, "isratr")
  end

  #     intnoがCRE_ISRã«å¯¾ã™ã‚‹å‰²è¾¼ã¿ç•ªå·ã¨ã—ã¦æ­£ã—ããªã„å ´åˆï¼ˆE_PAR）
  #     ï¼»NGKI3003ï¼½
  if $INTNO_CREISR_VALID.index(params[:intno]).nil?
    error_illegal("E_PAR", params, "intno")
  end

  #     (TMIN_ISRPRI <= isrpri && isrpri <= TMAX_ISRPRI)ã§ãªã„å ´åˆï¼ˆE_PAR）
  #     ï¼»NGKI3005ï¼½
  if !($TMIN_ISRPRI <= params[:isrpri] && params[:isrpri] <= $TMAX_ISRPRI)
    error_illegal("E_PAR", params, "isrpri")
  end
end

$INTNO_CREISR_VALID.each do |intnoVal|
  # 割込み番号intnoに対して登録されたISRのリストの作成
  isrParamsList = []
  $cfgData[:CRE_ISR].sort.each do |key, params|
    if params[:intno].val == intnoVal
      isrParamsList.push(params)
    end
  end

  #     割込み番号intnoに対して登録されたISRãŒå­˜åœ¨ã™ã‚‹å ´åˆ
  if isrParamsList.size > 0
    inhnoVal = $toInhnoVal[intnoVal]

    # intnoに対応するinhnoに対してDEF_INHãŒã‚ã‚‹å ´åˆï¼ˆE_OBJ）［NGKI3013ï¼½
    if $cfgData[:DEF_INH].has_key?(inhnoVal)
      inhnoParams = $cfgData[:DEF_INH][inhnoVal]
      error_ercd("E_OBJ", isrParamsList[0], \
                                        "intno `#{isrParamsList[0][:intno]}' in CRE_ISR" \
                                        " is duplicated with inhno #{inhnoParams[:inhno]}")
    end

    # intnoに対するCFG_INTãŒãªã„å ´åˆï¼ˆE_OBJ）［NGKI3012ï¼½
    if !$cfgData[:CFG_INT].has_key?(intnoVal)
      error_ercd("E_OBJ", isrParamsList[0], \
                                                "intno `#{isrParamsList[0][:intno]}'" \
                                                " is not configured with CFG_INT")
    else
      intnoParams = $cfgData[:CFG_INT][intnoVal]

      # intnoに対してCFG_INTで設定された割込み優å…
ˆåº¦ãŒTMIN_INTPRIよりも
      # å°ã•ã„å ´åˆï¼ˆE_OBJ）［NGKI3014ï¼½
      if intnoParams[:intpri] < $TMIN_INTPRI
        error_ercd("E_OBJ", isrParamsList[0],
                                                "intpri `#{intnoParams[:intpri]}' configured for" \
                                                " intno `#{isrParamsList[0][:intno]}}' in higher" \
                                                " than TMIN_INTPRI")
      end
    end

    # 次のDEF_INHに相当するデータを生成
    # DEF_INH(inhno, { TA_NULL, _kernel_inthdr_<intno> } );
    params = {
      :inhno => StrVal.new(inhnoVal.to_s, inhnoVal),
      :inhatr => $TA_NULL,
      :inthdr => StrVal.new("_kernel_inthdr_#{intnoVal}")
    }
    $cfgData[:DEF_INH][inhnoVal] = params

    # 割込みサービスルーチン用の割込みハンドラ
    $kernelCfgC.add("void")
    $kernelCfgC.add("_kernel_inthdr_#{intnoVal}(void)")
    $kernelCfgC.add("{")
    # 割込みサービスルーチンを優å…
ˆåº¦é †ã«å‘¼ã³å‡ºã™
    i = 0               # stable sortを行うための変数
    isrParamsList.sort_by {|params| [ params[:isrpri].val, i += 1 ]} \
                                                                                .each_with_index do |params, index|
      if index > 0
        $kernelCfgC.add
        $kernelCfgC.add("\tif (sense_lock()) {")
        $kernelCfgC.add("\t\tunlock_cpu();")
        $kernelCfgC.add2("\t}")
      end
      $kernelCfgC.add("\tLOG_ISR_ENTER(#{params[:isrid]});")
      $kernelCfgC.add("\t((ISR)(#{params[:isr]}))" \
                                                "((intptr_t)(#{params[:exinf]}));")
      $kernelCfgC.add("\tLOG_ISR_LEAVE(#{params[:isrid]});")
    end
    $kernelCfgC.add2("}")
  end
end

#
#  割込みハンドラのための標準的な初期化情
å ±ã®ç”Ÿæˆ
#
if $OMIT_INITIALIZE_INTERRUPT.nil? || !$USE_INHINIB_TABLE.nil?
  #
  #  定義する割込みハンドラの数
  #
  $kernelCfgC.append(<<EOS)
#define TNUM_DEF_INHNO  #{$cfgData[:DEF_INH].size}
const uint_t _kernel_tnum_def_inhno = TNUM_DEF_INHNO;

EOS

  if $cfgData[:DEF_INH].size != 0
    #
    #  割込みハンドラのエントリ
    #
    $cfgData[:DEF_INH].each do |key, params|
      if (params[:inhatr] & $TA_NONKERNEL) == 0
        $kernelCfgC.add("INTHDR_ENTRY(#{params[:inhno]}, " \
                                                "#{params[:inhno].val}, #{params[:inthdr]})")
      end
    end
    $kernelCfgC.add("")

    #
    #  割込みハンドラ初期化ブロック
    #
    $kernelCfgC.add("const INHINIB _kernel_inhinib_table[TNUM_DEF_INHNO] = {")
    $cfgData[:DEF_INH].each_with_index do |(key, params), index|
      $kernelCfgC.add(",") if index > 0
      if (params[:inhatr] & $TA_NONKERNEL) == 0
        inthdr = "(FP)(INT_ENTRY(#{params[:inhno]}, #{params[:inthdr]}))"
      else
        inthdr = "(FP)(#{params[:inthdr]})"
      end
      $kernelCfgC.append("\t{ (#{params[:inhno]}), (#{params[:inhatr]}), " \
                                                                                                                        "#{inthdr} }")
    end
    $kernelCfgC.add
    $kernelCfgC.add2("};")
  else
    $kernelCfgC.add2("TOPPERS_EMPTY_LABEL(const INHINIB, " \
                                                                                "_kernel_inhinib_table);")
  end
end

#
#  割込み要求ラインのための標準的な初期化情
å ±ã®ç”Ÿæˆ
#
if $OMIT_INITIALIZE_INTERRUPT.nil? || !$USE_INTINIB_TABLE.nil?
  #
  #  設定する割込み要求ラインの数
  #
  $kernelCfgC.append(<<EOS)
#define TNUM_CFG_INTNO  #{$cfgData[:CFG_INT].size}
const uint_t _kernel_tnum_cfg_intno = TNUM_CFG_INTNO;

EOS

  #
  #  割込み要求ライン初期化ブロック
  #
  if $cfgData[:CFG_INT].size != 0
    $kernelCfgC.add("const INTINIB _kernel_intinib_table[TNUM_CFG_INTNO] = {")
    $cfgData[:CFG_INT].each_with_index do |(key, params), index|
      $kernelCfgC.add(",") if index > 0
      $kernelCfgC.append("\t{ (#{params[:intno]}), (#{params[:intatr]}), " \
                                                                                                        "(#{params[:intpri]}) }")
    end
    $kernelCfgC.add
    $kernelCfgC.add2("};")
  else
    $kernelCfgC.add2("TOPPERS_EMPTY_LABEL(const INTINIB, " \
                                                                                "_kernel_intinib_table);")
  end
end

#
#  å‰²è¾¼ã¿ç®¡ç†æ©Ÿèƒ½åˆæœŸåŒ–é–¢æ•°ã®è¿½åŠ 
#
$initializeFunctions.push("_kernel_initialize_interrupt();")