开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > uCOS > 查看源码
mcf5xxx.c
资源名称：ucos.rar　[点击查看]
上传用户：dongxin
上传日期：2022-06-22
资源大小：370k
文件大小：7k
源码类别：

uCOS

开发平台：

Others

mcf5xxx.c：源码内容
  1. /*
  2.  * File: mcf5xxx.c
  3.  * Purpose: Generic high-level routines for ColdFire processors
  4.  *
  5.  * Notes:
  6.  */
  7. #include "support_common.h"
  8. #include <stdio.h>
  10. #ifdef __cplusplus
  11. extern "C" {
  12. #endif
  14. int __call_static_initializers(void);
  16. #ifdef __cplusplus
  17. }
  18. #endif
  21. /********************************************************************
  22.  * MCF5xxx ASM utility functions
  23.  */
  24. asm void mcf5xxx_wr_vbr(unsigned long) { /* Set VBR */
  25. move.l 4(SP),D0
  26.     movec d0,VBR 
  27. nop
  28. rts
  29. }
  31. /********************************************************************
  32.  * MCF5xxx startup copy functions:
  33.  *
  34.  * Set VBR and performs data initialization.
  35.  * The following symbols should be defined in the lcf:
  36.  * __DATA_ROM
  37.  * __DATA_RAM
  38.  * __DATA_END
  39.  * __BSS_START
  40.  * __BSS_END
  41.  * __VECTOR_RAM
  42.  *
  43.  * VECTOR_TABLE must be defined to the start of the VECTOR_TABLE in the code
  44.  * In case VECTOR_TABLE address is different from __VECTOR_RAM,
  45.  * the vector table is copied from VECTOR_TABLE to __VECTOR_RAM.
  46.  * In any case VBR is set to __VECTOR_RAM.
  47.  */ 
  48. void mcf5xxx_startup(void)
  49. {
  50. /*
  51.  * Memory map definitions from linker command files used by mcf5xxx_startup
  52.  */
  53. extern __declspec(system) uint8 __DATA_ROM[];
  54. extern __declspec(system) uint8 __DATA_RAM[];
  55. extern __declspec(system) uint8 __DATA_END[];
  56. extern __declspec(system) uint8 __BSS_START[];
  57. extern __declspec(system) uint8 __BSS_END[];
  58. extern __declspec(system) uint32 VECTOR_TABLE[];
  59. extern __declspec(system) uint32 __VECTOR_RAM[];
  61. register uint32 n;
  62. register uint8 *dp, *sp;
  64. /* 
  65.      * Copy the vector table to RAM 
  66.      */
  67. if (__VECTOR_RAM != VECTOR_TABLE)
  68. {
  69. for (n = 0; n < 256; n++)
  70. __VECTOR_RAM[n] = VECTOR_TABLE[n];
  71. }
  72. mcf5xxx_wr_vbr((uint32)__VECTOR_RAM);
  74. /* 
  75.  * Move initialized data from ROM to RAM. 
  76.  */
  77. if (__DATA_ROM != __DATA_RAM)
  78. {
  79. dp = (uint8 *)__DATA_RAM;
  80. sp = (uint8 *)__DATA_ROM;
  81. n = __DATA_END - __DATA_RAM;
  82. while (n--)
  83. *dp++ = *sp++;
  84. }
  85.  
  86. /* 
  87.  * Zero uninitialized data 
  88.  */
  89. if (__BSS_START != __BSS_END)
  90. {
  91. sp = (uint8 *)__BSS_START;
  92. n = __BSS_END - __BSS_START;
  93. while (n--)
  94. *sp++ = 0;
  95. }
  97.     /*
  98.  * Initialize static C++ objects
  99.  */
  100. __call_static_initializers();
  101. }
  103. /***********************************************************************
  104.  *
  105.  * This is the exception handler for all defined exceptions.  Most
  106.  * exceptions do nothing, but some of the more important ones are
  107.  * handled to some extent.
  108.  *
  109.  * Called by asm_exception_handler 
  110.  *
  111.  * The ColdFire family of processors has a simplified exception stack
  112.  * frame that looks like the following:
  113.  *
  114.  *              3322222222221111 111111
  115.  *              1098765432109876 5432109876543210
  116.  *           8 +----------------+----------------+
  117.  *             |         Program Counter         |
  118.  *           4 +----------------+----------------+
  119.  *             |FS/Fmt/Vector/FS|      SR        |
  120.  *   SP -->  0 +----------------+----------------+
  121.  *
  122.  * The stack self-aligns to a 4-byte boundary at an exception, with
  123.  * the FS/Fmt/Vector/FS field indicating the size of the adjustment
  124.  * (SP += 0,1,2,3 bytes).
  125.  */
  126. #define MCF5XXX_RD_SF_FORMAT(PTR)
  127. ((*((uint16 *)(PTR)) >> 12) & 0x00FF)
  129. #define MCF5XXX_RD_SF_VECTOR(PTR)
  130. ((*((uint16 *)(PTR)) >>  2) & 0x00FF)
  132. #define MCF5XXX_RD_SF_FS(PTR)
  133. ( ((*((uint16 *)(PTR)) & 0x0C00) >> 8) | (*((uint16 *)(PTR)) & 0x0003) )
  135. #define MCF5XXX_SF_SR(PTR) *((uint16 *)(PTR)+1)
  136. #define MCF5XXX_SF_PC(PTR) *((uint32 *)(PTR)+1)
  138. #define MCF5XXX_EXCEPTFMT  "%s -- PC = %#08Xn"
  140. void mcf5xxx_exception_handler(void *framep) 
  141. {
  142. switch (MCF5XXX_RD_SF_FORMAT(framep))
  143. {
  144. case 4:
  145. case 5:
  146. case 6:
  147. case 7:
  148. break;
  149. default:
  150. printf(MCF5XXX_EXCEPTFMT,"Illegal stack type", MCF5XXX_SF_PC(framep));
  151. break;
  152. }
  154. switch (MCF5XXX_RD_SF_VECTOR(framep))
  155. {
  156. case 2:
  157. printf(MCF5XXX_EXCEPTFMT, "Access Error", MCF5XXX_SF_PC(framep));
  158. switch (MCF5XXX_RD_SF_FS(framep))
  159. {
  160. case 4:
  161. printf("Error on instruction fetchn");
  162. break;
  163. case 8:
  164. printf("Error on operand writen");
  165. break;
  166. case 9:
  167. printf("Attempted write to write-protected spacen");
  168. break;
  169. case 12:
  170. printf("Error on operand readn");
  171. break;
  172. default:
  173. printf("Reserved Fault Status Encodingn");
  174. break;
  175. }
  176. break;
  177. case 3:
  178. printf(MCF5XXX_EXCEPTFMT, "Address Error", MCF5XXX_SF_PC(framep));
  179. switch (MCF5XXX_RD_SF_FS(framep))
  180. {
  181. case 4:
  182. printf("Error on instruction fetchn");
  183. break;
  184. case 8:
  185. printf("Error on operand writen");
  186. break;
  187. case 9:
  188. printf("Attempted write to write-protected spacen");
  189. break;
  190. case 12:
  191. printf("Error on operand readn");
  192. break;
  193. default:
  194. printf("Reserved Fault Status Encodingn");
  195. break;
  196. }
  197. break;
  198. case 4:
  199. printf(MCF5XXX_EXCEPTFMT, "Illegal instruction", MCF5XXX_SF_PC(framep));
  200. break;
  201. case 8:
  202. printf(MCF5XXX_EXCEPTFMT, "Privilege violation", MCF5XXX_SF_PC(framep));
  203. break;
  204. case 9:
  205. printf(MCF5XXX_EXCEPTFMT, "Trace Exception", MCF5XXX_SF_PC(framep));
  206. break;
  207. case 10:
  208. printf(MCF5XXX_EXCEPTFMT, "Unimplemented A-Line Instruction", 
  209. MCF5XXX_SF_PC(framep));
  210. break;
  211. case 11:
  212. printf(MCF5XXX_EXCEPTFMT, "Unimplemented F-Line Instruction", 
  213. MCF5XXX_SF_PC(framep));
  214. break;
  215. case 12:
  216. printf(MCF5XXX_EXCEPTFMT, "Debug Interrupt", MCF5XXX_SF_PC(framep));
  217. break;
  218. case 14:
  219. printf(MCF5XXX_EXCEPTFMT, "Format Error", MCF5XXX_SF_PC(framep));
  220. break;
  221. case 15:
  222. printf(MCF5XXX_EXCEPTFMT, "Unitialized Interrupt", MCF5XXX_SF_PC(framep));
  223. break;
  224. case 24:
  225. printf(MCF5XXX_EXCEPTFMT, "Spurious Interrupt", MCF5XXX_SF_PC(framep));
  226. break;
  227. case 25:
  228. case 26:
  229. case 27:
  230. case 28:
  231. case 29:
  232. case 30:
  233. case 31:
  234. printf("Autovector interrupt level %dn",
  235. MCF5XXX_RD_SF_VECTOR(framep) - 24);
  236. break;
  237. case 32:
  238. case 33:
  239. case 34:
  240. case 35:
  241. case 36:
  242. case 37:
  243. case 38:
  244. case 39:
  245. case 40:
  246. case 41:
  247. case 42:
  248. case 43:
  249. case 44:
  250. case 45:
  251. case 46:
  252. case 47:
  253. printf("TRAP #%dn", MCF5XXX_RD_SF_VECTOR(framep) - 32);
  254. break;
  255. case 5:
  256. case 6:
  257. case 7:
  258. case 13:
  259. case 16:
  260. case 17:
  261. case 18:
  262. case 19:
  263. case 20:
  264. case 21:
  265. case 22:
  266. case 23:
  267. case 48:
  268. case 49:
  269. case 50:
  270. case 51:
  271. case 52:
  272. case 53:
  273. case 54:
  274. case 55:
  275. case 56:
  276. case 57:
  277. case 58:
  278. case 59:
  279. case 60:
  280. case 61:
  281. case 62:
  282. case 63:
  283. printf("Reserved: #%dn", MCF5XXX_RD_SF_VECTOR(framep));
  284. break;
  285. default:
  286.             derivative_handle_interrupt(MCF5XXX_RD_SF_VECTOR(framep));
  287. break;
  288. }
  289. }