source: EcnlProtoTool/trunk/asp3_dcre/target/gr_peach_gcc/target_kernel_impl.c@ 270

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 *
 *  Copyright (C) 2007-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: target_kernel_impl.c 270 2017-02-09 04:03:47Z coas-nagasima $
 */

/*
 *              カーネルのターゲット依存部（GR-PEACH用）
 */

#include "kernel_impl.h"
#include <sil.h>
#include "arm.h"
#include "rza1.h"
#include "scif.h"
#include "core_pl310.h"
#include "us_ticker_api.h"

/*
 *  カーネル動作時のメモリマップと関連する定義
 *
 *  0x18000000 - 0x1fffffff：シリアルフラッシュメモリ（128MB）
 *  0x20000000 - 0x209fffff：内
蔵SRAM（10MB）
 *  0x3fe00000 - 0x3fffffff：I/Oé ˜åŸŸï¼ˆ2MBï¼‰ï¼Œäºˆç´„é ˜åŸŸã‚’å«ã‚€
 *  0xe8000000 - 0xffffffff：I/Oé ˜åŸŸï¼ˆ384MBï¼‰ï¼Œäºˆç´„é ˜åŸŸã‚’å«ã‚€
 */

/*
 *  MMUへの設定属性（第1レベルディスクリプタ）
 */
#define MMU_ATTR_RAM    (ARM_MMU_DSCR1_SHARED|ARMV6_MMU_DSCR1_APX0 \
                                                        |ARM_MMU_DSCR1_TEX001|ARM_MMU_DSCR1_AP11 \
                                                        |ARM_MMU_DSCR1_CB11)
#define MMU_ATTR_IODEV  (ARM_MMU_DSCR1_SHARED|ARMV6_MMU_DSCR1_APX0 \
                                                        |ARM_MMU_DSCR1_TEX000|ARM_MMU_DSCR1_AP11 \
                                                        |ARM_MMU_DSCR1_CB01|ARMV6_MMU_DSCR1_NOEXEC)
/*
 *  MMUの設定情
å ±ï¼ˆãƒ¡ãƒ¢ãƒªã‚¨ãƒªã‚¢ã®æƒ…
å ±ï¼‰
 */
ARM_MMU_CONFIG arm_memory_area[] = {
        { SPI_ADDR, SPI_ADDR, SPI_SIZE, MMU_ATTR_RAM },
        { SRAM_ADDR, SRAM_ADDR, SRAM_SIZE, MMU_ATTR_RAM },
        { IO1_ADDR, IO1_ADDR, IO1_SIZE, MMU_ATTR_IODEV },
        { IO2_ADDR, IO2_ADDR, IO2_SIZE, MMU_ATTR_IODEV }
};

/*
 *  MMUの設定情
å ±ã®æ•°ï¼ˆãƒ¡ãƒ¢ãƒªã‚¨ãƒªã‚¢ã®æ•°ï¼‰
 */
const uint_t arm_tnum_memory_area
                                        = sizeof(arm_memory_area) / sizeof(ARM_MMU_CONFIG);

/*
 *  低消費電力モードの初期化
 */
static void
lowpower_initialize(void)
{
        /* スタンバイモード時に端子状æ…
‹ã‚’維持する．CoreSight動作 */
        sil_wrb_mem(RZA1_STBCR2, 0x6a);
        (void) sil_reb_mem(RZA1_STBCR2);                /* ダミーリード */

        /* IEBus, irDA, LIN0, LIN1, MTU2, RSCAN2, ASC, PWM動作 */
        sil_wrb_mem(RZA1_STBCR3, 0x00);
        (void) sil_reb_mem(RZA1_STBCR3);                /* ダミーリード */

        /* SCIF0, SCIF1, SCIF2, SCIF3, SCIF4, SCIF5, SCIF6, SCIF7動作 */
        sil_wrb_mem(RZA1_STBCR4, 0x00);
        (void) sil_reb_mem(RZA1_STBCR4);                /* ダミーリード */

        /* SCIM0, SCIM1, SDG0, SDG1, SDG2, SDG3, OSTM0, OSTM1動作 */
        sil_wrb_mem(RZA1_STBCR5, 0x00);
        (void) sil_reb_mem(RZA1_STBCR5);                /* ダミーリード */

        /* A/D, CEU, DISCOM0, DISCOM1, DRC0, DRC1, JCU, RTClock動作 */
        sil_wrb_mem(RZA1_STBCR6, 0x00);
        (void) sil_reb_mem(RZA1_STBCR6);                /* ダミーリード */

        /* DVDEC0, DVDEC1, ETHER, FLCTL, USB0, USB1動作 */
        sil_wrb_mem(RZA1_STBCR7, 0x24);
        (void) sil_reb_mem(RZA1_STBCR7);                /* ダミーリード */

        /* IMR-LS20, IMR-LS21, IMR-LSD, MMCIF, MOST50, SCUX動作 */
        sil_wrb_mem(RZA1_STBCR8, 0x05);
        (void) sil_reb_mem(RZA1_STBCR8);                /* ダミーリード */

        /* I2C0, I2C1, I2C2, I2C3, SPIBSC0, SPIBSC1, VDC50, VDC51動作 */
        sil_wrb_mem(RZA1_STBCR9, 0x00);
        (void) sil_reb_mem(RZA1_STBCR9);                /* ダミーリード */

        /* RSPI0, RSPI1, RSPI2, RSPI3, RSPI4, CD-ROMDEC, RSPDIF, RGPVG動作 */
        sil_wrb_mem(RZA1_STBCR10, 0x00);
        (void) sil_reb_mem(RZA1_STBCR10);               /* ダミーリード */

        /* SSIF0, SSIF1, SSIF2, SSIF3, SSIF4, SSIF5動作 */
        sil_wrb_mem(RZA1_STBCR11, 0xc0);
        (void) sil_reb_mem(RZA1_STBCR11);               /* ダミーリード */

        /* SDHI00, SDHI01, SDHI10, SDHI11動作 */
        sil_wrb_mem(RZA1_STBCR12, 0xf0);
        (void) sil_reb_mem(RZA1_STBCR12);               /* ダミーリード */
}

/*
 *  汎用å…
¥å‡ºåŠ›ãƒãƒ¼ãƒˆã®åˆæœŸåŒ–（ポート／ペリフェラルå…
¼ç”¨ãƒ”ンのアサインの設定）
 */
static void
port_initialize(void)
{
        /* ポート6:ビット3（TxD2）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  3, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  3, 0);
        rza1_config_port(RZA1_PORT_PIPC(6),  3, 1);
        /* 第7å…
¼ç”¨æ©Ÿèƒ½ï¼ˆTxD2），出力 */
        rza1_config_port(RZA1_PORT_PMC(6),   3, 1);
        rza1_config_port(RZA1_PORT_PFCAE(6), 3, 1);
        rza1_config_port(RZA1_PORT_PFCE(6),  3, 1);
        rza1_config_port(RZA1_PORT_PFC(6),   3, 0);
        rza1_config_port(RZA1_PORT_PM(6),    3, 0);

        /* ポート6:ビット2（RxD2）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  2, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  2, 0);
        rza1_config_port(RZA1_PORT_PIPC(6),  2, 1);
        /* 第7å…
¼ç”¨æ©Ÿèƒ½ï¼ˆRxD2），å…
¥åŠ› */
        rza1_config_port(RZA1_PORT_PMC(6),   2, 1);
        rza1_config_port(RZA1_PORT_PFCAE(6), 2, 1);
        rza1_config_port(RZA1_PORT_PFCE(6),  2, 1);
        rza1_config_port(RZA1_PORT_PFC(6),   2, 0);
        rza1_config_port(RZA1_PORT_PM(6),    2, 1);

        /* ポート6:ビット13（LED1／赤）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  13, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  13, 0);
        /* ポートモード，出力 */
        rza1_config_port(RZA1_PORT_PMC(6),   13, 0);
        rza1_config_port(RZA1_PORT_PM(6),    13, 0);

        /* ポート6:ビット14（LED2／緑）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  14, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  14, 0);
        /* ポートモード，出力 */
        rza1_config_port(RZA1_PORT_PMC(6),   14, 0);
        rza1_config_port(RZA1_PORT_PM(6),    14, 0);

        /* ポート6:ビット15（LED3／青）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  15, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  15, 0);
        /* ポートモード，出力 */
        rza1_config_port(RZA1_PORT_PMC(6),   15, 0);
        rza1_config_port(RZA1_PORT_PM(6),    15, 0);

        /* ポート6:ビット12（LED4／ユーザ）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  12, 0);
        rza1_config_port(RZA1_PORT_PBDC(6),  12, 0);
        /* ポートモード，出力 */
        rza1_config_port(RZA1_PORT_PMC(6),   12, 0);
        rza1_config_port(RZA1_PORT_PM(6),    12, 0);

        /* ポート6:ビット0（ユーザボタン）の設定 */
        rza1_config_port(RZA1_PORT_PIBC(6),  0, 1);
        rza1_config_port(RZA1_PORT_PBDC(6),  0, 0);
        /* 第6å…
¼ç”¨æ©Ÿèƒ½ï¼ˆIRQ5），å…
¥åŠ› */
        rza1_config_port(RZA1_PORT_PMC(6),   0, 1);
        rza1_config_port(RZA1_PORT_PFCAE(6), 0, 1);
        rza1_config_port(RZA1_PORT_PFCE(6),  0, 0);
        rza1_config_port(RZA1_PORT_PFC(6),   0, 1);
        rza1_config_port(RZA1_PORT_PM(6),    0, 1);
}

/*
 *  システムログの低レベル出力のための初期化
 *
 *  セルタイプtPutLogGRPeach内
に実装
されている関数を直接呼び出す．
 */
extern void     tPutLogGRPeach_initialize(void);

/*
 *  ターゲット依存の初期化
 */
void
target_initialize(void)
{
        extern void     *vector_table;          /* ベクタテーブル */

        /*
         *  Low exception vectorsを使用
         */
        /*arm_set_low_vectors();*/

        /*
         *  チップ依存の初期化
         */
        /*chip_initialize();*/

        /*
         *  低消費電力モードの初期化
         */
        lowpower_initialize();

        /*
         *  汎用å…
¥å‡ºåŠ›ãƒãƒ¼ãƒˆã®åˆæœŸåŒ–（ポート／ペリフェラルå…
¼ç”¨ãƒ”ンのアサインの設定）
         */
        port_initialize();

        /*
         *  ベクタテーブルの設定
         */
        /*CP15_WRITE_VBAR((uint32_t) &vector_table);*/

        /*
         *  L2キャッシュコントローラ（PL310）の初期化
         */
        /*pl310_initialize(0x0U, ~0x0U);*/

        /*
         *  LEDを青色に点灯させる
         */
        gr_peach_set_led(GR_PEACH_LED_BLUE, 1);

        /*
         *  低レベル出力用にSIOを初期化
         */
#ifndef TOPPERS_OMIT_TECS
        tPutLogGRPeach_initialize();
#endif /* TOPPERS_OMIT_TECS */
}

/*
 *  ターゲット依存の終了処理
 */
void
target_exit(void)
{
        /*
         *  チップ依存の終了処理
         */
        chip_terminate();

        /*
         *  bkpt命令によりデバッガに制御を移す（パラメータが何が良いか未検討）
         */
        Asm("bkpt #0");

        while (true) ;
}

/*
 *  LEDの点灯／消灯
 */
void
gr_peach_set_led(uint_t led, uint_t set)
{
        rza1_config_port(RZA1_PORT_P(6), led, set);
}

void us_ticker_init(void)
{
}

uint32_t us_ticker_read()
{
        ER ret;
        SYSTIM now;

        ret = get_tim(&now);
        if(ret != E_OK)
                return 0;

        return now;
}

void us_ticker_set_interrupt(timestamp_t timestamp)
{
        Asm("bkpt #0");
}

void us_ticker_disable_interrupt(void)
{
}

void us_ticker_clear_interrupt(void)
{
}

void wait(float s)
{
        wait_us(s * 1000000.0f);
}

void wait_ms(int ms)
{
        wait_us(ms * 1000);
}

void wait_us(int us)
{
        ER ret;

        ret = dly_tsk(us);
        if (ret == E_CTX){
                uint32_t start = us_ticker_read();
                while ((us_ticker_read() - start) < (uint32_t)us);
        }
}