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

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  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: core_test.h 460 2015-08-29 13:04:06Z ertl-hiro $
 */

/*
 *              テストプログラムのコア依存部（ARM用）
 *
 *  このヘッダファイルは，target_test.h（または，そこからインクルードさ
 *  れるファイル）のみからインクルードされる．他のファイルから直接イン
 *  クルードしてはならない．
 */

#ifndef TOPPERS_CORE_TEST_H
#define TOPPERS_CORE_TEST_H

#include <t_stddef.h>
#include "arm.h"

/*
 *  CPU例外の発生
 */

#ifndef ILLEGAL_IADDR
#define ILLEGAL_IADDR                   0xd0000000U             /* 不正命令アドレス */
#endif /* ILLEGAL_IADDR */

#ifndef ILLEGAL_DADDR
#define ILLEGAL_DADDR                   0xd0000000U             /* 不正データアドレス */
#endif /* ILLEGAL_DADDR */

/*
 *  スーパバイザコールによるCPU例外の発生
 *
 *  CPU例外ハンドラから，そのままリターンすることができる．svc命令によ
 *  りlrレジスタが上書きされるため，lrãƒ¬ã‚¸ã‚¹ã‚¿ã¯ç ´å£Šã•ã‚Œã‚‹ã‚‚ã®ã¨æŒ‡å®šã—
 *  ている．
 */
#if defined(USE_SVC_CPUEXC)

#define CPUEXC1                                 EXCNO_SVC               /* スーパバイザコール */
#define RAISE_CPU_EXCEPTION             Asm("svc #0":::"lr")
#define PREPARE_RETURN_CPUEXC

/*
 *  プリフェッチアボートによるCPU例外の発生
 *
 *  プリフェッチアボートを起こした命令をスキップしてCPU例外ハンドラから
 *  リターンするために，戻り番地はそのままで良い（ARMモードで使うことを
 *  想定）．
 */
#elif defined(USE_PABORT_CPUEXC)

#define CPUEXC1                                 EXCNO_PABORT    /* プリフェッチアボート */
#define RAISE_CPU_EXCEPTION             ((void (*)(void)) ILLEGAL_IADDR)()
#define PREPARE_RETURN_CPUEXC

/*
 *  データアボートによるCPU例外の発生
 *
 *  データアボートを起こした命令をスキップしてCPU例外ハンドラからリター
 *  ンするために，戻り番地から4を減算する（ARMモードで使うことを想定）．
 */
#elif defined(USE_DABORT_CPUEXC)

#include "arm.h"
#define CPUEXC1                                 EXCNO_DABORT    /* データアボート */
#define RAISE_CPU_EXCEPTION             (void)(*((volatile uint32_t *) ILLEGAL_DADDR))
#define PREPARE_RETURN_CPUEXC   ((T_EXCINF *) p_excinf)->pc -= 4U

/*
 *  フェイタルデータアボート処理
 *
 *  スタックポインタを不正にして，フェイタルデータアボート処理を行わせ
 *  る．CPU例外ハンドラからはリターンできない．
 */
#elif defined(USE_FATAL_DABORT_CPUEXC)

#define CPUEXC1                                 EXCNO_DABORT    /* データアボート */
#define RAISE_CPU_EXCEPTION             Asm("mov sp, %0"::"I"(ILLEGAL_DADDR))

/*
 *  未定義命令によるCPU例外の発生
 *
 *  RAISE_CPU_EXCEPTIONは，ARMモードで使うことを想定している．CPU例外ハ
 *  ンドラから，そのままリターンすることができる．使用している未定義命
 *  令は，"Multiply and multiply accumulate"命令群のエンコーディング内

 *  における未定義命令である．
 */
#else

#define CPUEXC1                                 EXCNO_UNDEF             /* 未定義命令 */
#define RAISE_CPU_EXCEPTION             Asm(".word 0xf0500090")
#define PREPARE_RETURN_CPUEXC

#endif

/*
 *  パフォーマンスモニタによる性能評価
 */
#if defined(USE_ARM_PM_HIST) && __TARGET_ARCH_ARM == 7

/*
 *  パフォーマンスモニタのカウンタのデータ型
 */
typedef uint32_t        PMCNT;

/*
 *  パフォーマンスモニタの初期化
 */
Inline void
arm_init_pmcnt(void)
{
        uint32_t        reg;

        /*
         *  パフォーマンスモニタの有効化
         *
         *  TOPPERS_ARM_PMCNT_DIV64ãŒå®šç¾©ã•ã‚Œã¦ã„ã‚‹å ´åˆã¯ï¼Œ64クロック毎にカ
         *  ウントアップする．
         */
        CP15_READ_PMCR(reg);
        reg |= CP15_PMCR_ALLCNTR_ENABLE;

#ifdef TOPPERS_ARM_PMCNT_DIV64
        reg |= CP15_PMCR_PMCCNTR_DIVIDER;
#else /* !TOPPERS_ARM_PMCNT_DIV64 */
        reg &= ~CP15_PMCR_PMCCNTR_DIVIDER;
#endif /* TOPPERS_ARM_PMCNT_DIV64 */

        CP15_WRITE_PMCR(reg);

        /*
         *  パフォーマンスモニタのカウンタの有効化
         */
        CP15_READ_PMCNTENSET(reg);
        reg |= CP15_PMCNTENSET_CCNTR_ENABLE;
        CP15_WRITE_PMCNTENSET(reg);
}

/*
 *  パフォーマンスモニタのカウンタの読み込み
 */
Inline void 
arm_get_pmcnt(PMCNT *p_count)
{
        CP15_READ_PMCCNTR(*p_count);
}

/*
 *  カウンタ値の時間計測単位への変換
 *
 *  時間計測の単位は，現状はナノ秒になっている（マイクロ秒単位にする設
 *  定も欲しいと思われる）．
 */
Inline uint_t
arm_conv_time(PMCNT count) {
#ifdef TOPPERS_ARM_PMCNT_DIV64
        return(((uint_t) count) * (1000 * 64) / CORE_CLK_MHZ);
#else /* !TOPPERS_ARM_PMCNT_DIV64 */
        return(((uint_t) count) * 1000 / CORE_CLK_MHZ);
#endif /* TOPPERS_ARM_PMCNT_DIV64 */
}

#define HISTTIM                                 PMCNT
#define HIST_GET_TIM(p_time)    (arm_get_pmcnt(p_time))
#define HIST_CONV_TIM(time)             (arm_conv_tim(time))
#define HIST_BM_HOOK()                  ((void) 0)

#endif /* defined(USE_ARM_PM_HIST) && __TARGET_ARCH_ARM == 7 */
#endif /* TOPPERS_CORE_TEST_H */