hirado/kernel/config/m68k/cpu_insn.h

   1 /*
   2  *  TOPPERS/JSP Kernel
   3  *      Toyohashi Open Platform for Embedded Real-Time Systems/
   4  *      Just Standard Profile Kernel
   5  *
   6  *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
   7  *                              Toyohashi Univ. of Technology, JAPAN
   8  *
   9  *  上記著作権者は，以下の (1)〜(4) の条件か，Free Software Foundation
  10  *  によって公表されている GNU General Public License の Version 2 に記
  11  *  述されている条件を満たす場合に限り，本ソフトウェア（本ソフトウェア
  12  *  を改変したものを含む．以下同じ）を使用・複製・改変・再配布（以下，
  13  *  利用と呼ぶ）することを無償で許諾する．
  14  *  (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
  15  *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
  16  *      スコード中に含まれていること．
  17  *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
  18  *      用できる形で再配布する場合には，再配布に伴うドキュメント（利用
  19  *      者マニュアルなど）に，上記の著作権表示，この利用条件および下記
  20  *      の無保証規定を掲載すること．
  21  *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
  22  *      用できない形で再配布する場合には，次のいずれかの条件を満たすこ
  23  *      と．
  24  *    (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
  25  *        作権表示，この利用条件および下記の無保証規定を掲載すること．
  26  *    (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
  27  *        報告すること．
  28  *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
  29  *      害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
  30  *
  31  *  本ソフトウェアは，無保証で提供されているものである．上記著作権者お
  32  *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
  33  *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
  34  *  接的または間接的に生じたいかなる損害に関しても，その責任を負わない．
  35  *
  36  *  @(#) $Id: cpu_insn.h,v 1.1 2009/01/31 05:27:37 suikan Exp $
  37  */
  38
  39 /*
  40  *  プロセッサの特殊命令のインライン関数定義（M68040用）
  41  */
  42
  43 #ifndef _CPU_INSN_H_
  44 #define _CPU_INSN_H_
  45
  46 /*
  47  *  ステータスレジスタ（SR）の現在値の読出し
  48  */
  49 Inline UH
  50 current_sr()
  51 {
  52     UH  sr;
  53
  54     Asm("move.w %%sr, %0" : "=g"(sr));
  55     return(sr);
  56 }
  57
  58 /*
  59  *  ステータスレジスタ（SR）の現在値の変更
  60  */
  61 Inline void
  62 set_sr(UH sr)
  63 {
  64     Asm("move.w %0, %%sr" : : "g"(sr));
  65 }
  66
  67 /*
  68  *  NMIを除くすべての割込みを禁止
  69  */
  70 Inline void
  71 disint()
  72 {
  73     Asm("or.w #0x0700, %sr");
  74 }
  75
  76 /*
  77  *  すべての割込みを許可
  78  */
  79 Inline void
  80 enaint()
  81 {
  82     Asm("and.w #~0x0700, %sr");
  83 }
  84
  85 /*
  86  *  ベクタベースレジスタ（VBR）の現在値の読出し
  87  */
  88 Inline VP
  89 current_vbr()
  90 {
  91     VP  vbr;
  92
  93     Asm("movec.l %%vbr, %0" : "=r"(vbr));
  94     return(vbr);
  95 }
  96
  97 /*
  98  *  ベクタベースレジスタ（VBR）の設定
  99  */
 100 Inline void
 101 set_vbr(VP vbr)
 102 {
 103     Asm("movec.l %0, %%vbr" : : "r"(vbr));
 104 }
 105
 106 /*
 107  *  レディキューサーチのためのビットマップサーチ関数
 108  *
 109  *  ビットマップの下位16ビットを使用し，最下位ビットを最低優先度に対応
 110  *  させる．
 111  */
 112 #define CPU_BITMAP_SEARCH
 113 #define PRIMAP_BIT(pri)     (0x8000u >> (pri))
 114
 115 Inline UINT
 116 bitmap_search(UINT bitmap)
 117 {
 118     UINT    offset;
 119
 120     /*
 121      *  このコードは，bitmap（UINT型）が32ビットであることを仮定し
 122      *  ている．
 123      */
 124     Asm("bfffo %1{16,16}, %0" : "=d"(offset) : "g"(bitmap));
 125     return(offset - 16);
 126 }
 127
 128 #endif /* _CPU_INSN_H_ */