diff options
| author | Revo <projectrevotpp@hotmail.com> | 2020-04-30 19:55:00 -0400 |
|---|---|---|
| committer | GitHub <noreply@github.com> | 2020-04-30 19:55:00 -0400 |
| commit | 081bd6efce613ed078407ab8fd24765275385f9f (patch) | |
| tree | ea91f20d1cd1ab5ae06880d1dd2e5a2c61f4db59 /include/nitro/os_system.c | |
| parent | c7dd102f628b7a64a34223278c2de09718da19f4 (diff) | |
| parent | 2ac877a24f241d3bc9d875a1338c40d7325929c6 (diff) | |
Merge pull request #7 from martmists/os_lib
Add OS* functions
Diffstat (limited to 'include/nitro/os_system.c')
| -rw-r--r-- | include/nitro/os_system.c | 28 |
1 files changed, 28 insertions, 0 deletions
diff --git a/include/nitro/os_system.c b/include/nitro/os_system.c new file mode 100644 index 00000000..2ccb7fc1 --- /dev/null +++ b/include/nitro/os_system.c @@ -0,0 +1,28 @@ +// +// Created by mart on 4/23/20. +// + +#include "os_system.h" + +asm OSIntrMode OS_DisableInterrupts() { + mrs r0, cpsr + orr r1, r0, #HW_PSR_IRQ_DISABLE + msr cpsr_c, r1 + and r0, r0, #HW_PSR_IRQ_DISABLE + bx lr +} + +asm OSIntrMode OS_RestoreInterrupts(OSIntrMode state) { + mrs r1, cpsr + bic r2, r1, #HW_PSR_IRQ_DISABLE + orr r2, r2, r0 + msr cpsr_c, r2 + and r0, r1, #HW_PSR_IRQ_DISABLE + bx lr +} + +asm OSProcMode OS_GetProcMode() { + mrs r0, cpsr + and r0, r0, #HW_PSR_CPU_MODE_MASK + bx lr +}
\ No newline at end of file |