nold/Atmosphere
1
0
Fork 0
mirror of https://github.com/Atmosphere-NX/Atmosphere synced 2024-12-22 12:21:18 +00:00
Code Issues Projects Releases Packages Wiki Activity

Uncomment more sleep/suspend code

Browse source
This commit is contained in:
Michael Scire 2018-02-27 16:10:51 -08:00
parent 235b7b65e1
commit 7a9e031bff
5 changed files with 33 additions and 6 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

3
exosphere/src/arm.h
View file

@ -17,4 +17,7 @@ void invalidate_dcache_range(const void *start, const void *end);
void invalidate_icache_inner_shareable(void);
void call_with_stack_pointer(uintptr_t stack_pointer, void (*function)(void));
#endif

9
exosphere/src/arm.s
View file

@ -227,3 +227,12 @@ invalidate_icache_inner_shareable:
dsb ish
isb
ret
/* Call a function with desired stack pointer. */
.section .text.call_with_stack_pointer, "ax", %progbits
.type call_with_stack_pointer, %function
.global call_with_stack_pointer
call_with_stack_pointer:
mov sp, x0
br x1

16
exosphere/src/cpu_context.c
View file

@ -5,6 +5,7 @@
#include "flow.h"
#include "pmc.h"
#include "timers.h"
#include "smc_api.h"
#include "utils.h"
static saved_cpu_context_t g_cpu_contexts[NUM_CPU_CORES] = {0};
@ -72,10 +73,11 @@ void power_down_current_core(void) {
}
uint32_t cpu_off(void) {
if (get_core_id() == 3) {
unsigned int current_core = get_core_id();
if (current_core == 3) {
power_down_current_core();
} else {
/* TODO: call_with_stack_pointer(get_powerdown_stack(), power_down_current_core); */
call_with_stack_pointer(get_exception_entry_stack_address(current_core), power_down_current_core);
}
while (true) {
/* Wait forever. */
@ -220,3 +222,13 @@ void restore_current_core_context(void) {
g_cpu_contexts[current_core].is_saved = 0;
}
}
void set_current_core_active(void) {
g_cpu_contexts[get_core_id()].is_active = 1;
}
void set_current_core_inactive(void) {
g_cpu_contexts[get_core_id()].is_active = 0;
}

3
exosphere/src/cpu_context.h
View file

@ -47,6 +47,9 @@ typedef struct {
void save_current_core_context(void);
void restore_current_core_context(void);
void set_current_core_active(void);
void set_current_core_inactive(void);
void set_core_entrypoint_and_argument(uint32_t core, uint64_t entrypoint_addr, uint64_t argument);
uint32_t cpu_on(uint32_t core, uint64_t entrypoint_addr, uint64_t argument);

8
exosphere/src/lp0.c
View file

@ -7,6 +7,7 @@
#include "bpmp.h"
#include "arm.h"
#include "configitem.h"
#include "cpu_context.h"
#include "flow.h"
#include "fuse.h"
#include "i2c.h"
@ -121,10 +122,9 @@ uint32_t cpu_suspend(uint64_t power_state, uint64_t entrypoint, uint64_t argumen
/* Save core context. */
set_core_entrypoint_and_argument(current_core, entrypoint, argument);
/* TODO: save_current_core_context(); */
/* TODO: set_current_core_inacctive(); */
/* TODO: set_current_core_saved(true); */
/* TODO: call_with_stack_pointer(TZRAM_GET_SEGMENT_ADDR(TZRAM_SEGMENT_ID_CORE012_STACK) + 0x1000ULL, save_se_and_power_down_cpu); */
save_current_core_context();
set_current_core_inactive();
call_with_stack_pointer(get_smc_core012_stack_address(), save_se_and_power_down_cpu);
/* NOTE: This return never actually occurs. */
return 0;