source: asp3_wo_tecs/trunk/arch/arm_gcc/common/arm.c@ 302

/*
 *  TOPPERS Software
 *      Toyohashi Open Platform for Embedded Real-Time Systems
 *
 *  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.c 438 2015-08-09 01:37:47Z ertl-hiro $
 */

/*
 *              ARMコアサポートモジュール
 */

#include "arm.h"

/*
 *  キャッシュの操作
 */

/*
 *  データキャッシュのイネーブル
 */
void
arm_enable_dcache(void)
{
        uint32_t        reg;

        CP15_READ_SCTLR(reg);
        if ((reg & CP15_SCTLR_DCACHE) == 0U) {
                arm_invalidate_dcache();

                reg |= CP15_SCTLR_DCACHE;
                CP15_WRITE_SCTLR(reg);
        }
}

/*
 *  データキャッシュのディスエーブル
 *
 *  データキャッシュが無効な状æ…
‹ã§clean_and_invalidateを実行すると暴走
 *  ã™ã‚‹å ´åˆãŒã‚ã‚‹ãŸã‚ï¼Œãƒ‡ãƒ¼ã‚¿ã‚­ãƒ£ãƒƒã‚·ãƒ¥ã®çŠ¶æ…
‹ã‚’åˆ¤æ–­ã—ã¦ï¼Œç„¡åŠ¹ãªå ´åˆã¯ï¼Œ
 *  無効化のみを行う．
 */
void
arm_disable_dcache(void)
{
        uint32_t        reg;

        CP15_READ_SCTLR(reg);
        if ((reg & CP15_SCTLR_DCACHE) == 0U) {
                arm_invalidate_dcache();
        }
        else {
                reg &= ~CP15_SCTLR_DCACHE;
                CP15_WRITE_SCTLR(reg);

                arm_clean_and_invalidate_dcache();
        }
}

/*
 *  命令キャッシュのイネーブル
 */
void
arm_enable_icache(void)
{
        uint32_t        reg;

        CP15_READ_SCTLR(reg);
        if ((reg & CP15_SCTLR_ICACHE) == 0U) {
                arm_invalidate_icache();

                reg |= CP15_SCTLR_ICACHE;
                CP15_WRITE_SCTLR(reg);
        }
}

/*
 *  命令キャッシュのディスエーブル
 */
void
arm_disable_icache(void)
{
        uint32_t        reg;

        CP15_READ_SCTLR(reg);
        reg &= ~CP15_SCTLR_ICACHE;
        CP15_WRITE_SCTLR(reg);

        arm_invalidate_icache();
}

/*
 *  ARMv5におけるデータキャッシュのクリーンと無効化
 */
#if __TARGET_ARCH_ARM <= 5

void
armv5_clean_and_invalidate_dcache(void)
{
        ARMV5_CLEAN_AND_INVALIDATE_DCACHE();
}

#endif /* __TARGET_ARCH_ARM <= 5 */

/*
 *  ARMv7におけるデータキャッシュの無効化
 *
 *  レベル0のキャッシュのみを無効化する．
 */
#if __TARGET_ARCH_ARM == 7

void
armv7_invalidate_dcache(void)
{
        uint32_t        reg;
        uint32_t        way, no_ways, shift_way;
        uint32_t        set, no_sets, shift_set;

        CP15_WRITE_CSSELR(0U);
        CP15_READ_CCSIDR(reg);
        no_sets = ((reg >> 13) & 0x7fffU) + 1;
        shift_set = (reg & 0x07U) + 4;
        no_ways = ((reg >> 3) & 0x3ffU) + 1;
        shift_way = count_leading_zero(no_ways);

        for (way = 0; way < no_ways; way++){
                for (set = 0; set < no_sets; set++) {
                        reg = (way << shift_way) | (set << shift_set);
                        CP15_WRITE_DCISW(reg);
                }
        }
}

#endif /* __TARGET_ARCH_ARM == 7 */

/*
 *  ARMv7におけるデータキャッシュのクリーンと無効化
 *
 *  レベル0のキャッシュのみをクリーンと無効化する．
 */
#if __TARGET_ARCH_ARM == 7

void
armv7_clean_and_invalidate_dcache(void)
{
        uint32_t        reg;
        uint32_t        way, no_ways, shift_way;
        uint32_t        set, no_sets, shift_set;

        CP15_WRITE_CSSELR(0U);
        CP15_READ_CCSIDR(reg);
        no_sets = ((reg >> 13) & 0x7fffU) + 1;
        shift_set = (reg & 0x07U) + 4;
        no_ways = ((reg >> 3) & 0x3ffU) + 1;
        shift_way = count_leading_zero(no_ways);

        for (way = 0; way < no_ways; way++){
                for (set = 0; set < no_sets; set++) {
                        reg = (way << shift_way) | (set << shift_set);
                        CP15_WRITE_DCCISW(reg);
                }
        }
}

#endif /* __TARGET_ARCH_ARM == 7 */