diff options
Diffstat (limited to 'cc3200/util')
| -rw-r--r-- | cc3200/util/sleeprestore.h | 33 | ||||
| -rw-r--r-- | cc3200/util/sleeprestore.s | 61 |
2 files changed, 94 insertions, 0 deletions
diff --git a/cc3200/util/sleeprestore.h b/cc3200/util/sleeprestore.h new file mode 100644 index 0000000000..51416f0fce --- /dev/null +++ b/cc3200/util/sleeprestore.h @@ -0,0 +1,33 @@ +/* + * This file is part of the Micro Python project, http://micropython.org/ + * + * The MIT License (MIT) + * + * Copyright (c) 2015 Daniel Campora + * + * Permission is hereby granted, free of charge, to any person obtaining a copy + * of this software and associated documentation files (the "Software"), to deal + * in the Software without restriction, including without limitation the rights + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell + * copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in + * all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE + * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN + * THE SOFTWARE. + */ + +#ifndef SLEEPRESTORE_H_ +#define SLEEPRESTORE_H_ + +extern void sleep_store(void); +extern void sleep_restore(void); + +#endif /* SLEEPRESTORE_H_ */ diff --git a/cc3200/util/sleeprestore.s b/cc3200/util/sleeprestore.s new file mode 100644 index 0000000000..decc6994ec --- /dev/null +++ b/cc3200/util/sleeprestore.s @@ -0,0 +1,61 @@ + .syntax unified + .cpu cortex-m4 + .thumb + .text + .align 2 + +@ global variable with the backup registers + .extern vault_arm_registers +@ global function that performs the wake up actions + .extern pybsleep_suspend_exit + +@ uint sleep_store(void) + .global sleep_store + .thumb + .thumb_func + .type sleep_store, %function +sleep_store: + dsb + isb + push {r0-r12, lr} + ldr r1, =vault_arm_registers + mrs r0, msp + str r0, [r1] + mrs r0, psp + str r0, [r1, #4] + mrs r0, primask + str r0, [r1, #12] + mrs r0, faultmask + str r0, [r1, #16] + mrs r0, basepri + str r0, [r1, #20] + mrs r0, control + str r0, [r1, #24] + dsb + isb + bx lr + +@ uint sleep_restore(void) + .global sleep_restore + .thumb + .thumb_func + .type sleep_restore, %function +sleep_restore: + dsb + isb + mrs r0, msp + msr psp, r0 + ldr r1, =vault_arm_registers + ldr r0, [r1, #24] + msr control, r0 + ldr r0, [r1] + msr msp, r0 + ldr r0, [r1, #12] + msr primask, r0 + ldr r0, [r1, #16] + msr faultmask, r0 + ldr r0, [r1, #20] + msr basepri, r0 + dsb + isb + bl pybsleep_suspend_exit |