[352] | 1 | /*
|
---|
| 2 | * TOPPERS/ASP Kernel
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 4 | * Advanced Standard Profile Kernel
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | * Copyright (C) 2006-2017 by Embedded and Real-Time Systems Laboratory
|
---|
| 9 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 10 | *
|
---|
| 11 | * 上記著作権者は,以下の(1)~(4)の条件を満たす場合に限り,本ソフトウェ
|
---|
| 12 | * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
|
---|
| 13 | * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
|
---|
| 14 | * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
|
---|
| 15 | * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
|
---|
| 16 | * スコード中に含まれていること.
|
---|
| 17 | * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
|
---|
| 18 | * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
|
---|
| 19 | * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
|
---|
| 20 | * の無保証規定を掲載すること.
|
---|
| 21 | * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
|
---|
| 22 | * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
|
---|
| 23 | * と.
|
---|
| 24 | * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
|
---|
| 25 | * 作権表示,この利用条件および下記の無保証規定を掲載すること.
|
---|
| 26 | * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
|
---|
| 27 | * 報告すること.
|
---|
| 28 | * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
|
---|
| 29 | * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
|
---|
| 30 | * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
|
---|
| 31 | * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
|
---|
| 32 | * 免責すること.
|
---|
| 33 | *
|
---|
| 34 | * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
|
---|
| 35 | * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
|
---|
| 36 | * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
|
---|
| 37 | * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
|
---|
| 38 | * の責任を負わない.
|
---|
| 39 | *
|
---|
| 40 | * $Id$
|
---|
| 41 | */
|
---|
| 42 |
|
---|
| 43 | /*
|
---|
| 44 | * カーネルのチップ依存部(MPCore用)
|
---|
| 45 | */
|
---|
| 46 |
|
---|
| 47 | #include "kernel_impl.h"
|
---|
| 48 | #include <sil.h>
|
---|
| 49 | #include "arm.h"
|
---|
| 50 |
|
---|
| 51 | /*
|
---|
| 52 | * チップ依存の初期化
|
---|
| 53 | */
|
---|
| 54 | void
|
---|
| 55 | chip_initialize(void)
|
---|
| 56 | {
|
---|
| 57 | /*
|
---|
| 58 | * キャッシュをディスエーブル
|
---|
| 59 | */
|
---|
| 60 | arm_disable_cache();
|
---|
| 61 |
|
---|
| 62 | /*
|
---|
| 63 | * コア依存の初期化
|
---|
| 64 | */
|
---|
| 65 | core_initialize();
|
---|
| 66 |
|
---|
| 67 | /*
|
---|
| 68 | * MPCoreをSMPモードに設定
|
---|
| 69 | */
|
---|
| 70 | mpcore_enable_smp();
|
---|
| 71 |
|
---|
| 72 | /*
|
---|
| 73 | * SCUをイネーブル
|
---|
| 74 | */
|
---|
| 75 | mpcore_enable_scu();
|
---|
| 76 |
|
---|
| 77 | /*
|
---|
| 78 | * すべてのプロセッサをノーマルモードに
|
---|
| 79 | */
|
---|
| 80 | sil_wrw_mem(MPCORE_SCU_CPUSTAT, 0x00U);
|
---|
| 81 |
|
---|
| 82 | /*
|
---|
| 83 | * キャッシュをイネーブル
|
---|
| 84 | */
|
---|
| 85 | arm_enable_cache();
|
---|
| 86 |
|
---|
| 87 | /*
|
---|
| 88 | * GICのディストリビュータの初期化
|
---|
| 89 | */
|
---|
| 90 | gicd_initialize();
|
---|
| 91 |
|
---|
| 92 | /*
|
---|
| 93 | * GICのCPUインタフェースの初期化
|
---|
| 94 | */
|
---|
| 95 | gicc_initialize();
|
---|
| 96 | }
|
---|
| 97 |
|
---|
| 98 | /*
|
---|
| 99 | * チップ依存部の終了処理
|
---|
| 100 | */
|
---|
| 101 | void
|
---|
| 102 | chip_terminate(void)
|
---|
| 103 | {
|
---|
| 104 | extern void software_term_hook(void);
|
---|
| 105 | void (*volatile fp)(void) = software_term_hook;
|
---|
| 106 |
|
---|
| 107 | /*
|
---|
| 108 | * software_term_hookへのポインタを,一旦volatile指定のあるfpに代
|
---|
| 109 | * 入してから使うのは,0との比較が最適化で削除されないようにするた
|
---|
| 110 | * めである.
|
---|
| 111 | */
|
---|
| 112 | if (fp != 0) {
|
---|
| 113 | (*fp)();
|
---|
| 114 | }
|
---|
| 115 |
|
---|
| 116 | /*
|
---|
| 117 | * GICのCPUインタフェースの終了処理
|
---|
| 118 | */
|
---|
| 119 | gicc_terminate();
|
---|
| 120 |
|
---|
| 121 | /*
|
---|
| 122 | * GICのディストリビュータの終了処理
|
---|
| 123 | */
|
---|
| 124 | gicd_terminate();
|
---|
| 125 |
|
---|
| 126 | /*
|
---|
| 127 | * コア依存の終了処理
|
---|
| 128 | */
|
---|
| 129 | core_terminate();
|
---|
| 130 | }
|
---|