1 | /////////////////////////////////////////////////////////////////////////////////// |
---|
2 | // File : exc_handler.c |
---|
3 | // Date : 01/04/2012 |
---|
4 | // Author : alain greiner and joel porquet |
---|
5 | // Copyright (c) UPMC-LIP6 |
---|
6 | /////////////////////////////////////////////////////////////////////////////////// |
---|
7 | // The exc_handler.c and exc_handler.h files are part of the GIET nano-kernel. |
---|
8 | // They contains the exception handler code. |
---|
9 | /////////////////////////////////////////////////////////////////////////////////// |
---|
10 | |
---|
11 | #include <exc_handler.h> |
---|
12 | #include <ctx_handler.h> |
---|
13 | #include <sys_handler.h> |
---|
14 | #include <drivers.h> |
---|
15 | #include <common.h> |
---|
16 | |
---|
17 | /////////////////////////////////////////////////////////////////////////////////// |
---|
18 | // Prototypes of exception handlers. |
---|
19 | /////////////////////////////////////////////////////////////////////////////////// |
---|
20 | |
---|
21 | static void _cause_ukn(); |
---|
22 | static void _cause_adel(); |
---|
23 | static void _cause_ades(); |
---|
24 | static void _cause_ibe(); |
---|
25 | static void _cause_dbe(); |
---|
26 | static void _cause_bp(); |
---|
27 | static void _cause_ri(); |
---|
28 | static void _cause_cpu(); |
---|
29 | static void _cause_ovf(); |
---|
30 | |
---|
31 | extern void _int_handler(); |
---|
32 | extern void _sys_handler(); |
---|
33 | |
---|
34 | /////////////////////////////////////////////////////////////////////////////////// |
---|
35 | // Initialize the exception vector indexed by the CR XCODE field |
---|
36 | /////////////////////////////////////////////////////////////////////////////////// |
---|
37 | const _exc_func_t _cause_vector[16] = { |
---|
38 | &_int_handler, /* 0000 : external interrupt */ |
---|
39 | &_cause_ukn, /* 0001 : undefined exception */ |
---|
40 | &_cause_ukn, /* 0010 : undefined exception */ |
---|
41 | &_cause_ukn, /* 0011 : undefined exception */ |
---|
42 | &_cause_adel, /* 0100 : illegal address read exception */ |
---|
43 | &_cause_ades, /* 0101 : illegal address write exception */ |
---|
44 | &_cause_ibe, /* 0110 : instruction bus error exception */ |
---|
45 | &_cause_dbe, /* 0111 : data bus error exception */ |
---|
46 | &_sys_handler, /* 1000 : system call */ |
---|
47 | &_cause_bp, /* 1001 : breakpoint exception */ |
---|
48 | &_cause_ri, /* 1010 : illegal codop exception */ |
---|
49 | &_cause_cpu, /* 1011 : illegal coprocessor access */ |
---|
50 | &_cause_ovf, /* 1100 : arithmetic overflow exception */ |
---|
51 | &_cause_ukn, /* 1101 : undefined exception */ |
---|
52 | &_cause_ukn, /* 1110 : undefined exception */ |
---|
53 | &_cause_ukn, /* 1111 : undefined exception */ |
---|
54 | }; |
---|
55 | |
---|
56 | static const char* exc_type[] = { |
---|
57 | "strange unknown cause", |
---|
58 | "illegal read address", |
---|
59 | "illegal write address", |
---|
60 | "inst bus error", |
---|
61 | "data bus error", |
---|
62 | "breakpoint", |
---|
63 | "reserved instruction", |
---|
64 | "illegal coproc access" |
---|
65 | "arithmetic overflow", |
---|
66 | }; |
---|
67 | |
---|
68 | static void _display_cause(unsigned int type) |
---|
69 | { |
---|
70 | _puts("\n[GIET] Exception for task "); |
---|
71 | _putd( _get_current_task_id() ); |
---|
72 | _puts(" on processor "); |
---|
73 | _putd( _procid() ); |
---|
74 | _puts(" at cycle "); |
---|
75 | _putd( _proctime() ); |
---|
76 | _puts("\n - type : "); |
---|
77 | _puts( (char*)exc_type[type] ); |
---|
78 | _puts("\n - EPC : "); |
---|
79 | _putw( _get_epc() ); |
---|
80 | _puts("\n - BVAR : "); |
---|
81 | _putw( _get_bvar() ); |
---|
82 | _puts("\n"); |
---|
83 | |
---|
84 | // goes to sleeping state |
---|
85 | unsigned int task_id = _get_current_task_id(); |
---|
86 | _set_context_slot( task_id, CTX_RUN_ID, 0 ); |
---|
87 | |
---|
88 | // deschedule |
---|
89 | _ctx_switch(); |
---|
90 | } |
---|
91 | |
---|
92 | static void _cause_ukn() { _display_cause(0); } |
---|
93 | static void _cause_adel() { _display_cause(1); } |
---|
94 | static void _cause_ades() { _display_cause(2); } |
---|
95 | static void _cause_ibe() { _display_cause(3); } |
---|
96 | static void _cause_dbe() { _display_cause(4); } |
---|
97 | static void _cause_bp() { _display_cause(5); } |
---|
98 | static void _cause_ri() { _display_cause(6); } |
---|
99 | static void _cause_cpu() { _display_cause(7); } |
---|
100 | static void _cause_ovf() { _display_cause(8); } |
---|
101 | |
---|