1 | /*
|
---|
2 | * TOPPERS/ASP Kernel
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
4 | * Advanced Standard Profile Kernel
|
---|
5 | *
|
---|
6 | * Copyright (C) 2008-2011 by Embedded and Real-Time Systems Laboratory
|
---|
7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
8 | *
|
---|
9 | * ãLì ÒÍCȺÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
|
---|
10 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»Eü
|
---|
11 | * ÏEÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
12 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
13 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[
|
---|
14 | * XR[hÉÜÜêÄ¢é±ÆD
|
---|
15 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
|
---|
16 | * pÅ«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
17 | gip
|
---|
18 | * Ò}j
|
---|
19 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL
|
---|
20 | * ̳ÛØKèðfÚ·é±ÆD
|
---|
21 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
|
---|
22 | * pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
|
---|
23 | * ÆD
|
---|
24 | * (a) Äzzɺ¤hL
|
---|
25 | gipÒ}j
|
---|
26 | AÈÇjÉCãLÌ
|
---|
27 | * ì \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
28 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
|
---|
29 | * ñ·é±ÆD
|
---|
30 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹
|
---|
31 | * Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
32 | * ܽC{\tgEFAÌ[UܽÍGh[U©çÌ¢©Èé
|
---|
33 | * RÉîÿ©çàCãLì Ò¨æÑTOPPERSvWFNgð
|
---|
34 | * ÆÓ·é±ÆD
|
---|
35 | *
|
---|
36 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
|
---|
37 | * æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
|
---|
38 | * ÉηéK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEF
|
---|
39 | * AÌpÉæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»
|
---|
40 | * ÌÓCðíÈ¢D
|
---|
41 | *
|
---|
42 | */
|
---|
43 |
|
---|
44 | /*
|
---|
45 | * ^[Qbg˶W
|
---|
46 | [
|
---|
47 | */
|
---|
48 | #include "kernel_impl.h"
|
---|
49 | #include <sil.h>
|
---|
50 |
|
---|
51 | #include "fm3_mb9bxxx.h"
|
---|
52 | #include "target_serial.h"
|
---|
53 |
|
---|
54 | /*
|
---|
55 | * ^[Qbg˶Ìú»
|
---|
56 | */
|
---|
57 | void
|
---|
58 | target_initialize(void){
|
---|
59 |
|
---|
60 | static uint32_t u32IoRegisterRead;
|
---|
61 |
|
---|
62 | /*
|
---|
63 | * n[hEFAEEIb`hOE^C}Ìâ~
|
---|
64 | */
|
---|
65 | sil_wrw_mem((uint32_t*)FM3_HWWDT_WDG_LCK, 0x1ACCE551);
|
---|
66 | sil_wrw_mem((uint32_t*)FM3_HWWDT_WDG_LCK, 0xE5331AAE);
|
---|
67 | sil_wrb_mem((uint8_t*)FM3_HWWDT_WDG_CTL, 0);
|
---|
68 |
|
---|
69 | /*
|
---|
70 | * NbNÌÝè
|
---|
71 | */
|
---|
72 | sil_wrb_mem((uint8_t*)FM3_CRG_BSC_PSR, 0);
|
---|
73 | sil_wrb_mem((uint8_t*)FM3_CRG_APBC0_PSR, 0);
|
---|
74 | sil_wrb_mem((uint8_t*)FM3_CRG_APBC1_PSR, APBC1_PSR_APBC1EN | 1);
|
---|
75 | sil_wrb_mem((uint8_t*)FM3_CRG_APBC2_PSR, APBC2_PSR_APBC2EN | 1);
|
---|
76 | sil_wrb_mem((uint8_t*)FM3_CRG_SWC_PSR, SWC_PSR_TESTB | 3);
|
---|
77 | sil_wrb_mem((uint8_t*)FM3_CRG_TTC_PSR, 0);
|
---|
78 |
|
---|
79 | sil_wrb_mem((uint8_t*)FM3_CRG_CSW_TMR, (5 << 4) | 0x0C);
|
---|
80 |
|
---|
81 | sil_wrb_mem((uint8_t*)FM3_CRG_SCM_CTL, sil_reb_mem((uint8_t*)FM3_CRG_SCM_CTL) | SCM_CTL_MOSCE);
|
---|
82 | while (!(sil_reb_mem((uint8_t*)FM3_CRG_SCM_STR) & SCM_CTL_MOSCE));
|
---|
83 |
|
---|
84 | sil_wrb_mem((uint8_t*)FM3_CRG_PSW_TMR, 0);
|
---|
85 | sil_wrb_mem((uint8_t*)FM3_CRG_PLL_CTL1, ((1-1)<<4) | ((2-1)<<0));
|
---|
86 | sil_wrb_mem((uint8_t*)FM3_CRG_PLL_CTL2, 36-1);
|
---|
87 |
|
---|
88 | sil_wrb_mem((uint8_t*)FM3_CRG_SCM_CTL, sil_reb_mem((uint8_t*)FM3_CRG_SCM_CTL) | SCM_CTL_PLLE);
|
---|
89 | while (!(sil_reb_mem((uint8_t*)FM3_CRG_SCM_STR) & SCM_CTL_PLLE));
|
---|
90 |
|
---|
91 | sil_wrb_mem((uint8_t*)FM3_CRG_SCM_CTL, sil_reb_mem((uint8_t*)FM3_CRG_SCM_CTL) | (2 << 5));
|
---|
92 |
|
---|
93 | do
|
---|
94 | {
|
---|
95 | u32IoRegisterRead = (sil_reb_mem((uint8_t*)FM3_CRG_SCM_CTL) & 0xE0);
|
---|
96 | }while ((sil_reb_mem((uint8_t*)FM3_CRG_SCM_STR) & 0xE0) != u32IoRegisterRead);
|
---|
97 |
|
---|
98 | /*
|
---|
99 | * ¬CRg~OÌÝè
|
---|
100 | */
|
---|
101 | if( 0x000003FF != (sil_rew_mem((uint32_t*)FM3_FLASH_IF_CRTRMM) & 0x000003FF) )
|
---|
102 | {
|
---|
103 | sil_wrw_mem((uint32_t*)FM3_CRTRIM_MCR_RLR, 0x1ACCE554);
|
---|
104 | sil_wrw_mem((uint32_t*)FM3_CRTRIM_MCR_FTRM, sil_rew_mem((uint32_t*)FM3_FLASH_IF_CRTRMM));
|
---|
105 | sil_wrw_mem((uint32_t*)FM3_CRTRIM_MCR_RLR, 0x00000000);
|
---|
106 | }
|
---|
107 |
|
---|
108 | /*
|
---|
109 | * RA˶Ìú»
|
---|
110 | */
|
---|
111 | core_initialize();
|
---|
112 |
|
---|
113 | /*
|
---|
114 | * oi[oÍpÌVAú»
|
---|
115 | */
|
---|
116 | target_uart_init(SIO_PORTID);
|
---|
117 | }
|
---|
118 |
|
---|
119 |
|
---|
120 | /*
|
---|
121 | * ^[Qbg˶ÌI¹
|
---|
122 | */
|
---|
123 | void
|
---|
124 | target_exit(void)
|
---|
125 | {
|
---|
126 | /*
|
---|
127 | * RA˶ÌI¹
|
---|
128 | */
|
---|
129 | core_terminate();
|
---|
130 |
|
---|
131 | /*
|
---|
132 | * J«˶ÌI¹
|
---|
133 | */
|
---|
134 | while(1);
|
---|
135 | }
|
---|
136 |
|
---|
137 |
|
---|
138 | /*
|
---|
139 | * VXeOÌáxoÍ̽ß̶oÍ
|
---|
140 | */
|
---|
141 | void
|
---|
142 | target_fput_log(char c)
|
---|
143 | {
|
---|
144 | if (c == '\n') {
|
---|
145 | sio_pol_snd_chr('\r', SIO_PORTID);
|
---|
146 | }
|
---|
147 | sio_pol_snd_chr(c, SIO_PORTID);
|
---|
148 | }
|
---|