source: asp3_wo_tecs/trunk/target/ct11mpcore_gcc/target_kernel_impl.c@ 302

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2007-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: target_kernel_impl.c 365 2015-07-26 13:18:44Z ertl-hiro $
 */

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

#include "kernel_impl.h"
#include <sil.h>
#include "arm.h"
#include "uart_pl011.h"

/*
 *  カーネル動作時のメモリマップと関連する定義
 *
 *  0x00000000 - 0x00100000ï¼šãƒ™ã‚¯ã‚¿ãƒ¼é ˜åŸŸï¼ˆ1MB）
 *  0x00100000 - 0x0FFFFFFF：DRAM（255MB）
 *  0x10000000 - 0x100FFFFF：Emulation Baseboard上のリソース（1MB）
 *  0x10100000 - 0x101FFFFF：Private Memory Region（1MB）(*)
 *  0x48000000 - 0x4BFFFFFF：SRAM（4MB）
 *
 *  (*) Private Memory Regionのå…
ˆé ­ç•ªåœ°ã¯ï¼Œãƒœãƒ¼ãƒ‰ã®è¨­å®šã§å¤‰æ›´ã§ãã‚‹ï¼Ž
 */

/*
 *  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)
#define MMU_ATTR_VECTOR (ARMV6_MMU_DSCR1_APX0 \
                                                        |ARM_MMU_DSCR1_TEX001|ARM_MMU_DSCR1_AP11 \
                                                        |ARM_MMU_DSCR1_CB11)

/*
 *  ãƒ¡ãƒ¢ãƒªé ˜åŸŸã®å…
ˆé ­ç•ªåœ°ã¨ã‚µã‚¤ã‚º
 */
#define SDRAM_ADDR              0x00100000
#define SDRAM_SIZE              0x0ff00000              /* 255MB */
#define SDRAM_ATTR              MMU_ATTR_RAM

#define SRAM_ADDR               0x48000000
#define SRAM_SIZE               0x04000000              /* 16MB */
#define SRAM_ATTR               MMU_ATTR_RAM

/*
 *  ãƒ‡ãƒã‚¤ã‚¹ãƒ¬ã‚¸ã‚¹ã‚¿é ˜åŸŸã®å…
ˆé ­ç•ªåœ°ã¨ã‚µã‚¤ã‚º
 */
#define EB_SYS_ADDR             EB_SYS_BASE
#define EB_SYS_SIZE             0x00100000              /* 1MB */
#define EB_SYS_ATTR             MMU_ATTR_IODEV

#define PMR_ADDR                MPCORE_PMR_BASE
#define PMR_SIZE                0x00100000              /* 1MB */
#define PMR_ATTR                MMU_ATTR_IODEV

/*
 *  ãƒ™ã‚¯ã‚¿ãƒ†ãƒ¼ãƒ–ãƒ«ã‚’ç½®ããƒ¡ãƒ¢ãƒªé ˜åŸŸ
 */
#if defined(CORE0)
#define VECTOR_ADDR             0x01000000
#elif defined(CORE1)
#define VECTOR_ADDR             0x02000000
#elif defined(CORE2)
#define VECTOR_ADDR             0x03000000
#elif defined(CORE3)
#define VECTOR_ADDR             0x04000000
#endif
#define VECTOR_SIZE             0x00100000              /* 1MB */
#define VECTOR_ATTR             MMU_ATTR_VECTOR

/*
 *  MMUの設定情
å ±ï¼ˆãƒ¡ãƒ¢ãƒªã‚¨ãƒªã‚¢ã®æƒ…
å ±ï¼‰
 */
ARM_MMU_CONFIG arm_memory_area[] = {
        { 0x00000000, VECTOR_ADDR, VECTOR_SIZE, VECTOR_ATTR },
        { SRAM_ADDR, SRAM_ADDR, SRAM_SIZE, SRAM_ATTR },
        { EB_SYS_ADDR, EB_SYS_ADDR, EB_SYS_SIZE, EB_SYS_ATTR },
        { PMR_ADDR, PMR_ADDR, PMR_SIZE, PMR_ATTR },
        { SDRAM_ADDR, SDRAM_ADDR, SDRAM_SIZE, SDRAM_ATTR }
};

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

/*
 *  UARTからのポーリング出力
 */
static void
ct11mpcore_uart_fput(char c)
{
        /*
         *  送信バッファが空くまでポーリング
         */
        while (!(uart_pl011_putready(FPUT_UART_BASE))) ;

        /*
         *  送信する文字の書込み
         */
        uart_pl011_putchar(FPUT_UART_BASE, c);
}

/*
 *  システムログの低レベル出力のための文字出力
 */
void
target_fput_log(char c)
{
        if (c == '\n') {
                ct11mpcore_uart_fput('\r');
        }
        ct11mpcore_uart_fput(c);
}

/*
 *  UARPからのポーリング出力のための初期化
 */
static void
ct11mpcore_uart_initialize(void)
{
        /*
         *  UARTをディスエーブル
         */
        sil_wrw_mem(UART_CR(FPUT_UART_BASE), 0U);

        /*
         *  エラーフラグをクリア
         */
    sil_wrw_mem(UART_ECR(FPUT_UART_BASE), 0U);

        /*
         *  FIFOを空にする
         */
        while (uart_pl011_getready(FPUT_UART_BASE)) {
                (void) uart_pl011_getchar(FPUT_UART_BASE);
        }

        /*
         *  ãƒœãƒ¼ãƒ¬ãƒ¼ãƒˆã¨é€šä¿¡è¦æ ¼ã‚’è¨­å®š
         */
        sil_wrw_mem(UART_IBRD(FPUT_UART_BASE), EB_UART_IBRD_38400);
        sil_wrw_mem(UART_FBRD(FPUT_UART_BASE), EB_UART_FBRD_38400);
        sil_wrw_mem(UART_LCR_H(FPUT_UART_BASE), UART_LCR_H_WLEN8);
                
        /*
         *  UARTをイネーブル
         */
        sil_wrw_mem(UART_CR(FPUT_UART_BASE),
                                                UART_CR_UARTEN|UART_CR_TXE|UART_CR_RXE);
}

/*
 *  ターゲット依存の初期化
 */
void
target_initialize(void)
{
        uint32_t        reg;

        /*
         *  チップ依存の初期化
         */
        chip_initialize();
        
        /*
         *  Emulation Baseboardの割込みモードの設定
         */
        sil_wrw_mem(EB_SYS_LOCK, EB_SYS_LOCK_UNLOCK);   /* ロック解除 */

        reg = sil_rew_mem(EB_SYS_PLD_CTRL1);
        reg &= ~EB_SYS_PLD_CTRL1_INTMODE_MASK;
        reg |= EB_SYS_PLD_CTRL1_INTMODE_NEW_NODCC;
        sil_wrw_mem(EB_SYS_PLD_CTRL1, reg);

        sil_wrw_mem(EB_SYS_LOCK, EB_SYS_LOCK_LOCK);             /* ロック */
        
        /*
         *  UARTを初期化
         */
        ct11mpcore_uart_initialize();
}

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

        /*
         *  ターゲット依存の終了処理
         */
#if defined(TOPPERS_USE_QEMU) && !defined(TOPPERS_OMIT_QEMU_SEMIHOSTING)
        /*
         *  QEMUを終了させる．
         */
        Asm("mov r0, #24\n\t"
                "svc 0x00123456");
#endif
        while (true) ;
}