source: asp3_wo_tecs/trunk/arch/arm_gcc/common/arm_insn.h@ 302

/*
 *  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) 2006-2015 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: arm_insn.h 438 2015-08-09 01:37:47Z ertl-hiro $
 */

/*
 *              ARMコアの特殊命令のインライン関数定義
 *
 *  このヘッダファイルは，arm.hからインクルードされる．arm.hから分離し
 *  ているのは，コンパイラによるインラインアセンブラの記述方法の違いを
 *  吸収するために，このファイルのみを置き換えればよいようにするためで
 *  ある．
 */

#ifndef TOPPERS_ARM_INSN_H
#define TOPPERS_ARM_INSN_H

#include <t_stddef.h>

/*
 *  CLZ（Count Leading Zero）命令
 */
#if __TARGET_ARCH_ARM >= 6

Inline uint32_t
count_leading_zero(uint32_t val)
{
        uint32_t        count;

        Asm("clz %0, %1" : "=r"(count) : "r"(val));
        return(count);
}

#endif /* __TARGET_ARCH_ARM >= 6 */

/*
 *  メモリが変更されることをコンパイラに伝えるためのマクロ
 */
#define ARM_MEMORY_CHANGED      Asm("":::"memory")

/*
 *  ステータスレジスタの操作関数
 */
#ifndef __thumb__

/*
 *  ステータスレジスタ（CPSR）の現在値の読出し
 */
Inline uint32_t
current_cpsr(void)
{
        uint32_t        cpsr;

        Asm("mrs %0, cpsr" : "=r"(cpsr));
        return(cpsr);
}

/*
 *  ステータスレジスタ（CPSR）の現在値の変更
 */
Inline void
set_cpsr(uint32_t cpsr)
{
        Asm("msr cpsr_cxsf, %0" : : "r"(cpsr) : "memory","cc");
}

#else /* __thumb__ */
/*
 *  Thumbモードではmrs/msr命令が使用できないため，関数として実現して，
 *  ARMモードに移行して実行する．
 */

/*
 *  ステータスレジスタ（CPSR）の現在値の読出し
 */
extern uint32_t current_cpsr(void);

/*
 *  ステータスレジスタ（CPSR）の現在値の変更
 */
extern void set_cpsr(uint32_t cpsr);

#endif /* __thumb__ */

/*
 *  割込み禁止／許可関数
 *
 *  ARMv6ã‹ã‚‰è¿½åŠ ã•ã‚ŒãŸã‚·ã‚¹ãƒ†ãƒ çŠ¶æ…
‹ã‚’変更する命令を使った割込み禁止／許
 *  可のための関数．
 */
#if __TARGET_ARCH_ARM >= 6

/*
 *  IRQの禁止
 */
Inline void
disable_irq(void)
{
        Asm("cpsid i");
}

/*
 *  IRQの許可
 */
Inline void
enable_irq(void)
{
        Asm("cpsie i");
}

/*
 *  FIQの禁止
 */
Inline void
disable_fiq(void)
{
        Asm("cpsid f");
}

/*
 *  FIQの許可
 */
Inline void
enable_fiq(void)
{
        Asm("cpsie f");
}

/*
 *  FIQとIRQの禁止
 */
Inline void
disable_fiq_irq(void)
{
        Asm("cpsid fi");
}

/*
 *  FIQとIRQの許可
 */
Inline void
enable_fiq_irq(void)
{
        Asm("cpsie fi");
}

#endif /* __TARGET_ARCH_ARM >= 6 */

/*
 *  CP15のIDレジスタ操作マクロ
 */

/* メインIDレジスタ */
#define CP15_READ_MIDR(reg)             Asm("mrc p15, 0, %0, c0, c0, 0":"=r"(reg))

/* マルチプロセッサアフィニティレジスタ（ARMv6以降）*/
#if __TARGET_ARCH_ARM >= 6
#define CP15_READ_MPIDR(reg)    Asm("mrc p15, 0, %0, c0, c0, 5":"=r"(reg))
#endif /* __TARGET_ARCH_ARM >= 6 */

/* キャッシュタイプレジスタ */
#define CP15_READ_CTR(reg)              Asm("mrc p15, 0, %0, c0, c0, 1":"=r"(reg))

#if __TARGET_ARCH_ARM == 7
/* キャッシュレベルIDレジスタ（ARMv7） */
#define CP15_READ_CLIDR(reg)    Asm("mrc p15, 1, %0, c0, c0, 1":"=r"(reg))

/* キャッシュサイズ選択レジスタ（ARMv7）*/
#define CP15_WRITE_CSSELR(reg)  Asm("mcr p15, 2, %0, c0, c0, 0"::"r"(reg))

/* キャッシュサイズIDレジスタ（ARMv7）*/
#define CP15_READ_CCSIDR(reg)   Asm("mrc p15, 1, %0, c0, c0, 0":"=r"(reg))
#endif /* __TARGET_ARCH_ARM == 7 */

/*
 *  CP15のシステム制御レジスタ操作マクロ
 */

/* システム制御レジスタ */
#define CP15_READ_SCTLR(reg)    Asm("mrc p15, 0, %0, c1, c0, 0":"=r"(reg))
#define CP15_WRITE_SCTLR(reg)   Asm("mcr p15, 0, %0, c1, c0, 0"::"r"(reg))

/* 補助制御レジスタ（機能はチップ依存）*/
#define CP15_READ_ACTLR(reg)    Asm("mrc p15, 0, %0, c1, c0, 1":"=r"(reg))
#define CP15_WRITE_ACTLR(reg)   Asm("mcr p15, 0, %0, c1, c0, 1"::"r"(reg))

/*
 *  CP15によるキャッシュ操作マクロ
 */

/* 命令キャッシュå…
¨ä½“の無効化 */
#define CP15_INVALIDATE_ICACHE() \
                                                                Asm("mcr p15, 0, %0, c7, c5, 0"::"r"(0))

/* データキャッシュå…
¨ä½“の無効化（ARMv6以前）*/
#if __TARGET_ARCH_ARM <= 6
#define CP15_INVALIDATE_DCACHE() Asm("mcr p15, 0, %0, c7, c6, 0"::"r"(0))
#endif /* __TARGET_ARCH_ARM <= 6 */

/* 統合キャッシュå…
¨ä½“の無効化（ARMv6以前）*/
#if __TARGET_ARCH_ARM <= 6
#define CP15_INVALIDATE_UCACHE() Asm("mcr p15, 0, %0, c7, c7, 0"::"r"(0))
#endif /* __TARGET_ARCH_ARM <= 6 */

/* データキャッシュå…
¨ä½“のクリーンと無効化（ARMv5のみ）*/
#if __TARGET_ARCH_ARM <= 5
#define ARMV5_CLEAN_AND_INVALIDATE_DCACHE() \
                                                Asm("1: mrc p15, 0, apsr_nzcv, c7, c14, 3; bne 1b")
#endif /* __TARGET_ARCH_ARM <= 5 */

/* データキャッシュå…
¨ä½“のクリーンと無効化（ARMv6のみ）*/
#if __TARGET_ARCH_ARM == 6
#define CP15_CLEAN_AND_INVALIDATE_DCACHE() \
                                                                Asm("mcr p15, 0, %0, c7, c14, 0"::"r"(0))
#endif /* __TARGET_ARCH_ARM == 6 */

/* 統合キャッシュå…
¨ä½“のクリーンと無効化（ARMv6のみ）*/
#if __TARGET_ARCH_ARM == 6
#define CP15_CLEAN_AND_INVALIDATE_UCACHE() \
                                                                Asm("mcr p15, 0, %0, c7, c15, 0"::"r"(0))
#endif /* __TARGET_ARCH_ARM == 6 */

/* データキャッシュのセット／ウェイ単位の無効化 */
#define CP15_WRITE_DCISW(reg)   Asm("mcr p15, 0, %0, c7, c6, 2"::"r"(reg))

/* データキャッシュのセット／ウェイ単位のクリーンと無効化 */
#define CP15_WRITE_DCCISW(reg)  Asm("mcr p15, 0, %0, c7, c14, 2"::"r"(reg))

/*
 *  CP15のフォールト状æ…
‹ï¼ã‚¢ãƒ‰ãƒ¬ã‚¹ã®æ“ä½œãƒžã‚¯ãƒ­
 */
#if __TARGET_ARCH_ARM >= 6
#define CP15_READ_DFSR(reg)             Asm("mrc p15, 0, %0, c5, c0, 0":"=r"(reg))
#define CP15_READ_DFAR(reg)             Asm("mrc p15, 0, %0, c6, c0, 0":"=r"(reg))
#define CP15_READ_IFSR(reg)             Asm("mrc p15, 0, %0, c5, c0, 1":"=r"(reg))
#define CP15_READ_IFAR(reg)             Asm("mrc p15, 0, %0, c6, c0, 2":"=r"(reg))
#else /* __TARGET_ARCH_ARM >= 6 */
#define CP15_READ_FSR(reg)              Asm("mrc p15, 0, %0, c5, c0, 0":"=r"(reg))
#define CP15_READ_FAR(reg)              Asm("mrc p15, 0, %0, c6, c0, 0":"=r"(reg))
#endif /* __TARGET_ARCH_ARM >= 6 */

/*
 *  CP15によるMMUの操作マクロ（VMSA）
 */

/* 変換テーブルベース制御レジスタ（ARMv6以降）*/
#if __TARGET_ARCH_ARM >= 6
#define CP15_WRITE_TTBCR(reg)   Asm("mcr p15, 0, %0, c2, c0, 2"::"r"(reg))
#endif /* __TARGET_ARCH_ARM >= 6 */

/* 変換テーブルベースレジスタ0 */
#define CP15_READ_TTBR0(reg)    Asm("mrc p15, 0, %0, c2, c0, 0":"=r"(reg))
#define CP15_WRITE_TTBR0(reg)   Asm("mcr p15, 0, %0, c2, c0, 0"::"r"(reg))

/* ドメインアクセス制御レジスタ */
#define CP15_WRITE_DACR(reg)    Asm("mcr p15, 0, %0, c3, c0, 0":: "r"(reg))

/* コンテキストIDレジスタ（ARMv6以降）*/
#if __TARGET_ARCH_ARM >= 6
#define CP15_WRITE_CONTEXTIDR(reg) Asm("mcr p15, 0, %0, c13, c0, 1" ::"r"(reg))
#endif /* __TARGET_ARCH_ARM >= 6 */

/*
 *  CP15によるTLB操作マクロ（VMSA）
 */

/* TLBå…
¨ä½“の無効化 */
#define CP15_INVALIDATE_TLB()   Asm("mcr p15, 0, %0, c8, c7, 0"::"r"(0))

/*
 *  CP15のパフォーマンスモニタ操作マクロ（ARMv7のみ）
 */
#if __TARGET_ARCH_ARM == 7

/* パフォーマンスモニタ制御レジスタ */
#define CP15_READ_PMCR(reg)             Asm("mrc p15, 0, %0, c9, c12, 0":"=r"(reg))
#define CP15_WRITE_PMCR(reg)    Asm("mcr p15, 0, %0, c9, c12, 0"::"r"(reg))

/* パフォーマンスモニタカウントイネーブルセットレジスタ */
#define CP15_READ_PMCNTENSET(reg)  Asm("mrc p15, 0, %0, c9, c12, 1":"=r"(reg))
#define CP15_WRITE_PMCNTENSET(reg) Asm("mcr p15, 0, %0, c9, c12, 1"::"r"(reg))

/* パフォーマンスモニタカウンタサイクルレジスタ */
#define CP15_READ_PMCCNTR(reg)  Asm("mrc p15, 0, %0, c9, c13, 0":"=r"(reg))
#define CP15_WRITE_PMCCNTR(reg) Asm("mcr p15, 0, %0, c9, c13, 0"::"r"(reg))

#endif /* __TARGET_ARCH_ARM == 7 */

/*
 *  CP15によるメモリバリア操作マクロ
 */
#define CP15_INST_SYNC_BARRIER() \
                                                Asm("mcr p15, 0, %0, c7, c5, 4"::"r"(0):"memory")
#define CP15_DATA_SYNC_BARRIER() \
                                                Asm("mcr p15, 0, %0, c7, c10, 4"::"r"(0):"memory")
#define CP15_DATA_MEMORY_BARRIER() \
                                                Asm("mcr p15, 0, %0, c7, c10, 5"::"r"(0):"memory")

/*
 *  メモリバリア
 *
 *  ARMv6とARMv7が持つ3つのメモリバリア機能を使用するための関数．メモリ
 *  バリアは，ARMv7では専用命令，ARMv6ではCP15への書込みで実現される．
 *  ARMv7のメモリバリア命令は，同期を取る範囲を指定できるが，以下の関数
 *  では最大範囲（システムå…
¨ä½“，リード／ライトの両方）で同期を取る．
 */

/*
 *  データメモリバリア
 *
 *  ã“ã®ãƒãƒªã‚¢ã®å‰å¾Œã§ï¼Œãƒ¡ãƒ¢ãƒªã‚¢ã‚¯ã‚»ã‚¹ã®é †åºãŒå…
¥ã‚Œæ›ã‚ã‚‰ãªã„ようにする．
 *  マルチコア（厳密にはマルチマスタ）での使用を想定した命令．
 */
Inline void
data_memory_barrier(void)
{
#if __TARGET_ARCH_ARM <= 6
        CP15_DATA_MEMORY_BARRIER();
#else /* __TARGET_ARCH_ARM <= 6 */
        Asm("dmb":::"memory");
#endif /* __TARGET_ARCH_ARM <= 6 */
}

/*
 *  データ同期バリア
 *
 *  å…
ˆè¡Œã™ã‚‹ãƒ¡ãƒ¢ãƒªã‚¢ã‚¯ã‚»ã‚¹ãŒå®Œäº†ã™ã‚‹ã®ã‚’å¾…
つ．メモリアクセスが副作用を
 *  持つ時に，その副作用が起こるのを待
つための使用を想定した命令．
 */
Inline void
data_sync_barrier(void)
{
#if __TARGET_ARCH_ARM <= 6
        CP15_DATA_SYNC_BARRIER();
#else /* __TARGET_ARCH_ARM <= 6 */
        Asm("dsb":::"memory");
#endif /* __TARGET_ARCH_ARM <= 6 */
}

/*
 *  命令同期バリア
 *
 *  プログラムが書き換えられた（または，システム状æ…
‹ã®å¤‰åŒ–により実行す
 *  べきプログラムが変わった）時に，パイプラインをフラッシュするなど，
 *  新しいプログラムを読み込むようにする．ARMv6では，プリフェッチフラッ
 *  シュと呼ばれている．
 */
Inline void
inst_sync_barrier(void)
{
#if __TARGET_ARCH_ARM <= 6
        CP15_INST_SYNC_BARRIER();
#else /* __TARGET_ARCH_ARM <= 6 */
        Asm("isb":::"memory");
#endif /* __TARGET_ARCH_ARM <= 6 */
}

#endif /* TOPPERS_ARM_INSN_H */