|
12 | 12 | // See the License for the specific language governing permissions and |
13 | 13 | // limitations under the License. |
14 | 14 |
|
| 15 | +use aarch64_rt::{ExceptionHandlers, RegisterStateRef, exception_handlers}; |
15 | 16 | use arm_gic::gicv3::{GicCpuInterface, InterruptGroup}; |
16 | 17 | use log::{error, info, trace}; |
17 | 18 | use smccc::Hvc; |
18 | 19 | use smccc::psci::system_off; |
19 | 20 |
|
20 | | -// SAFETY: There is no other global function of this name. |
21 | | -#[unsafe(no_mangle)] |
22 | | -extern "C" fn sync_exception_current(_elr: u64, _spsr: u64) { |
23 | | - error!("sync_exception_current"); |
24 | | - system_off::<Hvc>().unwrap(); |
25 | | -} |
| 21 | +struct Handlers; |
26 | 22 |
|
27 | | -// SAFETY: There is no other global function of this name. |
28 | | -#[unsafe(no_mangle)] |
29 | | -extern "C" fn irq_current(_elr: u64, _spsr: u64) { |
30 | | - trace!("irq_current"); |
31 | | - let intid = |
32 | | - GicCpuInterface::get_and_acknowledge_interrupt(InterruptGroup::Group1) |
33 | | - .expect("No pending interrupt"); |
34 | | - info!("IRQ {intid:?}"); |
35 | | -} |
| 23 | +impl ExceptionHandlers for Handlers { |
| 24 | + extern "C" fn sync_current(_state: RegisterStateRef) { |
| 25 | + error!("sync_exception_current"); |
| 26 | + system_off::<Hvc>().unwrap(); |
| 27 | + } |
36 | 28 |
|
37 | | -// SAFETY: There is no other global function of this name. |
38 | | -#[unsafe(no_mangle)] |
39 | | -extern "C" fn fiq_current(_elr: u64, _spsr: u64) { |
40 | | - error!("fiq_current"); |
41 | | - system_off::<Hvc>().unwrap(); |
42 | | -} |
| 29 | + extern "C" fn irq_current(_state: RegisterStateRef) { |
| 30 | + trace!("irq_current"); |
| 31 | + let intid = |
| 32 | + GicCpuInterface::get_and_acknowledge_interrupt(InterruptGroup::Group1) |
| 33 | + .expect("No pending interrupt"); |
| 34 | + info!("IRQ {intid:?}"); |
| 35 | + } |
43 | 36 |
|
44 | | -// SAFETY: There is no other global function of this name. |
45 | | -#[unsafe(no_mangle)] |
46 | | -extern "C" fn serr_current(_elr: u64, _spsr: u64) { |
47 | | - error!("serr_current"); |
48 | | - system_off::<Hvc>().unwrap(); |
49 | | -} |
| 37 | + extern "C" fn fiq_current(_state: RegisterStateRef) { |
| 38 | + error!("fiq_current"); |
| 39 | + system_off::<Hvc>().unwrap(); |
| 40 | + } |
50 | 41 |
|
51 | | -// SAFETY: There is no other global function of this name. |
52 | | -#[unsafe(no_mangle)] |
53 | | -extern "C" fn sync_lower(_elr: u64, _spsr: u64) { |
54 | | - error!("sync_lower"); |
55 | | - system_off::<Hvc>().unwrap(); |
56 | | -} |
| 42 | + extern "C" fn serror_current(_state: RegisterStateRef) { |
| 43 | + error!("serr_current"); |
| 44 | + system_off::<Hvc>().unwrap(); |
| 45 | + } |
57 | 46 |
|
58 | | -// SAFETY: There is no other global function of this name. |
59 | | -#[unsafe(no_mangle)] |
60 | | -extern "C" fn irq_lower(_elr: u64, _spsr: u64) { |
61 | | - error!("irq_lower"); |
62 | | - system_off::<Hvc>().unwrap(); |
63 | | -} |
| 47 | + extern "C" fn sync_lower(_state: RegisterStateRef) { |
| 48 | + error!("sync_lower"); |
| 49 | + system_off::<Hvc>().unwrap(); |
| 50 | + } |
64 | 51 |
|
65 | | -// SAFETY: There is no other global function of this name. |
66 | | -#[unsafe(no_mangle)] |
67 | | -extern "C" fn fiq_lower(_elr: u64, _spsr: u64) { |
68 | | - error!("fiq_lower"); |
69 | | - system_off::<Hvc>().unwrap(); |
70 | | -} |
| 52 | + extern "C" fn irq_lower(_state: RegisterStateRef) { |
| 53 | + error!("irq_lower"); |
| 54 | + system_off::<Hvc>().unwrap(); |
| 55 | + } |
71 | 56 |
|
72 | | -// SAFETY: There is no other global function of this name. |
73 | | -#[unsafe(no_mangle)] |
74 | | -extern "C" fn serr_lower(_elr: u64, _spsr: u64) { |
75 | | - error!("serr_lower"); |
76 | | - system_off::<Hvc>().unwrap(); |
| 57 | + extern "C" fn fiq_lower(_state: RegisterStateRef) { |
| 58 | + error!("fiq_lower"); |
| 59 | + system_off::<Hvc>().unwrap(); |
| 60 | + } |
| 61 | + |
| 62 | + extern "C" fn serror_lower(_state: RegisterStateRef) { |
| 63 | + error!("serr_lower"); |
| 64 | + system_off::<Hvc>().unwrap(); |
| 65 | + } |
77 | 66 | } |
| 67 | + |
| 68 | +exception_handlers!(Handlers); |
0 commit comments