[128] | 1 | /*
|
---|
| 2 | * TOPPERS ATK2
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems
|
---|
| 4 | * Automotive Kernel Version 2
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2011-2015 by Center for Embedded Computing Systems
|
---|
| 7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 8 | * Copyright (C) 2011-2015 by FUJI SOFT INCORPORATED, JAPAN
|
---|
| 9 | * Copyright (C) 2011-2013 by Spansion LLC, USA
|
---|
| 10 | * Copyright (C) 2011-2015 by NEC Communication Systems, Ltd., JAPAN
|
---|
| 11 | * Copyright (C) 2011-2015 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
|
---|
| 12 | * Copyright (C) 2011-2014 by Renesas Electronics Corporation, JAPAN
|
---|
| 13 | * Copyright (C) 2011-2015 by Sunny Giken Inc., JAPAN
|
---|
| 14 | * Copyright (C) 2011-2015 by TOSHIBA CORPORATION, JAPAN
|
---|
| 15 | * Copyright (C) 2011-2015 by Witz Corporation
|
---|
| 16 | * Copyright (C) 2014-2015 by AISIN COMCRUISE Co., Ltd., JAPAN
|
---|
| 17 | * Copyright (C) 2014-2015 by eSOL Co.,Ltd., JAPAN
|
---|
| 18 | * Copyright (C) 2014-2015 by SCSK Corporation, JAPAN
|
---|
| 19 | *
|
---|
| 20 | * 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
|
---|
| 21 | * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
|
---|
| 22 | * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
|
---|
| 23 | * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
|
---|
| 24 | * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
|
---|
| 25 | * スコード中に含まれていること.
|
---|
| 26 | * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
|
---|
| 27 | * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
|
---|
| 28 | * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
|
---|
| 29 | * の無保証規定を掲載すること.
|
---|
| 30 | * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
|
---|
| 31 | * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
|
---|
| 32 | * と.
|
---|
| 33 | * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
|
---|
| 34 | * 作権表示,この利用条件および下記の無保証規定を掲載すること.
|
---|
| 35 | * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
|
---|
| 36 | * 報告すること.
|
---|
| 37 | * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
|
---|
| 38 | * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
|
---|
| 39 | * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
|
---|
| 40 | * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
|
---|
| 41 | * 免責すること.
|
---|
| 42 | *
|
---|
| 43 | * 本ソフトウェアは,AUTOSAR(AUTomotive Open System ARchitecture)仕
|
---|
| 44 | * 様に基づいている.上記の許諾は,AUTOSARの知的財産権を許諾するもので
|
---|
| 45 | * はない.AUTOSARは,AUTOSAR仕様に基づいたソフトウェアを商用目的で利
|
---|
| 46 | * 用する者に対して,AUTOSARパートナーになることを求めている.
|
---|
| 47 | *
|
---|
| 48 | * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
|
---|
| 49 | * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
|
---|
| 50 | * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
|
---|
| 51 | * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
|
---|
| 52 | * の責任を負わない.
|
---|
| 53 | *
|
---|
| 54 | * $Id: SmpC1ISR.S 1801 2015-03-27 06:34:43Z t_ishikawa $
|
---|
| 55 | */
|
---|
| 56 |
|
---|
| 57 | #define TOPPERS_MACRO_ONLY
|
---|
| 58 |
|
---|
| 59 | #define UINT_C(val) (val)
|
---|
| 60 | #define CAST(type, val) (val) /* 型キャストを行うマクロ */
|
---|
| 61 |
|
---|
| 62 | #include "kernel/kernel_impl.h"
|
---|
| 63 | #include "vic.h"
|
---|
| 64 | #include "nios2.h"
|
---|
| 65 | #include "target_test.h"
|
---|
| 66 |
|
---|
| 67 | .global C1ISRMainSmpC1ISR
|
---|
| 68 | .set noat
|
---|
| 69 |
|
---|
| 70 | C1ISRMainSmpC1ISR:
|
---|
| 71 | addi ea, ea, -4 /* 戻り番地をデクリメント */
|
---|
| 72 |
|
---|
| 73 | /* レジスタの保存 */
|
---|
| 74 | addi sp, sp, -76
|
---|
| 75 | stw at, 0(sp)
|
---|
| 76 | stw r2, 4(sp)
|
---|
| 77 | stw r3, 8(sp)
|
---|
| 78 | stw r4, 12(sp)
|
---|
| 79 | stw r5, 16(sp)
|
---|
| 80 | stw r6, 20(sp)
|
---|
| 81 | stw r7, 24(sp)
|
---|
| 82 | stw r8, 28(sp)
|
---|
| 83 | stw r9, 32(sp)
|
---|
| 84 | stw r10, 36(sp)
|
---|
| 85 | stw r11, 40(sp)
|
---|
| 86 | stw r12, 44(sp)
|
---|
| 87 | stw r13, 48(sp)
|
---|
| 88 | stw r14, 52(sp)
|
---|
| 89 | stw r15, 56(sp)
|
---|
| 90 | stw ra, 60(sp)
|
---|
| 91 | stw ea, 64(sp)
|
---|
| 92 | rdctl et, estatus
|
---|
| 93 | stw et, 68(sp)
|
---|
| 94 |
|
---|
| 95 | rdctl r2, status
|
---|
| 96 | ori r2, r2, STATUS_PIE
|
---|
| 97 | wrctl status, r2
|
---|
| 98 |
|
---|
| 99 | /* 割込み発生前のcallevel_statをスタックに保存 */
|
---|
| 100 | ldh r2, %gprel(callevel_stat)(gp)
|
---|
| 101 | stw r2, 72(sp)
|
---|
| 102 |
|
---|
| 103 |
|
---|
| 104 | /* callevel_statにC1ISRをセット */
|
---|
| 105 | ldhu et, %gprel(callevel_stat)(gp)
|
---|
| 106 | ori et, et, TSYS_ISR1
|
---|
| 107 | sth et, %gprel(callevel_stat)(gp)
|
---|
| 108 |
|
---|
| 109 | /*
|
---|
| 110 | * タイマ割込みをクリア
|
---|
| 111 | */
|
---|
| 112 | movia et, TIMER_STATUS(TIMER_5_IRQ)
|
---|
| 113 | stwio zero, 0(et)
|
---|
| 114 |
|
---|
| 115 | call c1isr_syslog
|
---|
| 116 |
|
---|
| 117 | ldw r2, 72(sp)
|
---|
| 118 | sth r2, %gprel(callevel_stat)(gp)
|
---|
| 119 |
|
---|
| 120 | rdctl r2, status
|
---|
| 121 | movi r3, ~STATUS_PIE
|
---|
| 122 | and r2, r2, r3
|
---|
| 123 | wrctl status, r2
|
---|
| 124 |
|
---|
| 125 | /* レジスタの復帰 */
|
---|
| 126 | ldw at, 0(sp)
|
---|
| 127 | ldw r2, 4(sp)
|
---|
| 128 | ldw r3, 8(sp)
|
---|
| 129 | ldw r4, 12(sp)
|
---|
| 130 | ldw r5, 16(sp)
|
---|
| 131 | ldw r6, 20(sp)
|
---|
| 132 | ldw r7, 24(sp)
|
---|
| 133 | ldw r8, 28(sp)
|
---|
| 134 | ldw r9, 32(sp)
|
---|
| 135 | ldw r10, 36(sp)
|
---|
| 136 | ldw r11, 40(sp)
|
---|
| 137 | ldw r12, 44(sp)
|
---|
| 138 | ldw r13, 48(sp)
|
---|
| 139 | ldw r14, 52(sp)
|
---|
| 140 | ldw r15, 56(sp)
|
---|
| 141 | ldw ra, 60(sp)
|
---|
| 142 | ldw ea, 64(sp)
|
---|
| 143 | ldw et, 68(sp)
|
---|
| 144 | wrctl estatus, et
|
---|
| 145 | addi sp, sp, 76
|
---|
| 146 |
|
---|
| 147 | eret
|
---|