arno/trezor-firmware
1
0
Fork 0
mirror of https://github.com/trezor/trezor-firmware.git synced 2024-11-17 21:22:10 +00:00
Code Issues Releases Wiki Activity

feat(core): implement svc shutdown

Browse Source
This commit is contained in:
Ondřej Vejpustek 2021-06-14 13:28:25 +02:00
parent cca9d4b1c4
commit 4968d7da53
2 changed files with 20 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
core/embed/firmware/main.c
View File

@ -49,6 +49,9 @@
#include "supervise.h"
#include "touch.h"
// from util.s
extern void shutdown_privileged(void);
int main(void) {
random_delays_init();
@ -180,6 +183,11 @@ void SVC_C_Handler(uint32_t *stack) {
cyccnt_cycles = *DWT_CYCCNT_ADDR;
break;
#endif
case SVC_SHUTDOWN:
shutdown_privileged();
for (;;)
;
break;
default:
stack[0] = 0xffffffff;
break;

12
core/embed/trezorhal/supervise.h
View File

@ -3,6 +3,10 @@
#define SVC_ENABLE_IRQ 0
#define SVC_DISABLE_IRQ 1
#define SVC_SET_PRIORITY 2
#define SVC_SHUTDOWN 4
// from util.s
extern void shutdown_privileged(void);
static inline uint32_t is_mode_unprivileged(void) {
uint32_t r0;
@ -38,3 +42,11 @@ static inline void svc_setpriority(uint32_t IRQn, uint32_t priority) {
NVIC_SetPriority(IRQn, priority);
}
}
static inline void svc_shutdown(void) {
if (is_mode_unprivileged()) {
__asm__ __volatile__("svc %0" ::"i"(SVC_SHUTDOWN) : "memory");
} else {
shutdown_privileged();
}
}