source: EcnlProtoTool/trunk/asp3_dcre/arch/arm_gcc/common/core_pl310.c@ 270

/*
 *  TOPPERS Software
 *      Toyohashi Open Platform for Embedded Real-Time Systems
 * 
 *  Copyright (C) 2013-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: core_pl310.c 270 2017-02-09 04:03:47Z coas-nagasima $
 */

/*
 *              L2キャッシュコントローラ（PL310）の操作ライブラリ
 */

#include "kernel_impl.h"
#include "core_pl310.h"

Inline uint32_t
get_way_mask(void)
{
        uint32_t        aux;
        
        aux = sil_rew_mem(PL310_AUX_CTRL);
        if ((aux & PL310_AUX_CTRL_ASSOCIATIVITY) != 0U) {
                /* 16ウェイ */
                return(0x0000ffffU);
        }
        else {
                /* 8ウェイ */
                return(0x000000ffU);
        }
}

Inline void
pl310_cache_sync(void)
{
        sil_wrw_mem(PL310_CACHE_SYNC, 0);
}

Inline void
pl310_inv_all(void)
{
        uint32_t        way_mask = get_way_mask();

        /* すべてのウェイを無効化する */
        sil_wrw_mem(PL310_INV_WAY, 0xffff);
        while ((sil_rew_mem(PL310_INV_WAY) & way_mask) != 0U) ;
        pl310_cache_sync();
}

Inline void
pl310_debug_set(uint32_t val)
{
        sil_wrw_mem(PL310_DEBUG_CTRL, val);
}

/*
 *  PL310の初期化
 */
void
pl310_initialize(uint32_t aux_val, uint32_t aux_mask)
{
        uint32_t        aux;
        uint32_t        prefetch;
        uint32_t        prefetch_val = 0U;

        /* L2ã‚­ãƒ£ãƒƒã‚·ãƒ¥ãŒãƒ‡ã‚£ã‚¹ã‚¨ãƒ¼ãƒ–ãƒ«ã®å ´åˆã®ã¿åˆæœŸåŒ–ã‚’è¡Œã† */
        if ((sil_rew_mem(PL310_CTRL) & 0x01) == 0U) {
                /* å…
±æœ‰å±žæ€§ã‚’無視する */
                aux_val |= PL310_AUX_CTRL_IGNORE_SHARE;

                /* 命令プリフェッチをイネーブル */
                aux_val |= PL310_AUX_CTRL_INST_PREFETCH;
                prefetch_val |= PL310_AUX_CTRL_INST_PREFETCH;

                /* データプリフェッチをイネーブル */
                aux_val |= PL310_AUX_CTRL_DATA_PREFETCH;
                prefetch_val |= PL310_AUX_CTRL_DATA_PREFETCH;

                /* ダブルラインフィルをイネーブル */
                prefetch_val |= PL310_PREFETCH_CTRL_DLINEFILL;
                prefetch_val |= PL310_PREFETCH_CTRL_INCR_DLINEFILL;
                
                /* 補助制御レジスタを設定 */
                aux = sil_rew_mem(PL310_AUX_CTRL);
                sil_wrw_mem(PL310_AUX_CTRL, ((aux & aux_mask) | aux_val));

                /* プリフェッチ制御レジスタを設定 */
                prefetch = sil_rew_mem(PL310_PREFETCH_CTRL);
                sil_wrw_mem(PL310_PREFETCH_CTRL, (prefetch | prefetch_val));

                /* L2キャッシュのå…
¨ä½“の無効化 */
                pl310_inv_all();
        
                /* クロックゲーティングとスタンバイモードをイネーブル */
                sil_wrw_mem(PL310_POWER_CTRL, 0x03);
        
                /* L2キャッシュのイネーブル */
                sil_wrw_mem(PL310_CTRL, 0x01);
        }    
}

/*
 *  L2キャッシュのディスエーブル
 */
void
pl310_disable(void)
{
        pl310_clean_and_invalidate_all();
        sil_wrw_mem(PL310_CTRL, 0x00);
}

/*
 *  L2キャッシュå…
¨ä½“の無効化（書き戻さない）
 */
void
pl310_invalidate_all(void)
{
        pl310_debug_set(0x03);
        pl310_inv_all();
        pl310_debug_set(0x00);
}

/*
 *  L2キャッシュå…
¨ä½“のクリーンと無効化
 */
void
pl310_clean_and_invalidate_all(void)
{
        uint32_t        way_mask = get_way_mask();

        pl310_debug_set(0x03);
        sil_wrw_mem(PL310_CLEAN_INV_WAY, way_mask);
        while ((sil_rew_mem(PL310_CLEAN_INV_WAY) & way_mask) != 0U) ;
        pl310_cache_sync();
        pl310_debug_set(0x00);
}