mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2024-11-08 13:11:49 +00:00
fusee: perform only pmic reboots on mariko
This commit is contained in:
parent
a0769844f4
commit
2b48743265
2 changed files with 159 additions and 80 deletions
|
@ -22,9 +22,11 @@
|
||||||
#include "fuse.h"
|
#include "fuse.h"
|
||||||
#include "pmc.h"
|
#include "pmc.h"
|
||||||
#include "timers.h"
|
#include "timers.h"
|
||||||
|
#include "i2c.h"
|
||||||
#include "panic.h"
|
#include "panic.h"
|
||||||
#include "car.h"
|
#include "car.h"
|
||||||
#include "btn.h"
|
#include "btn.h"
|
||||||
|
#include "max77620.h"
|
||||||
#include "../../../fusee/common/log.h"
|
#include "../../../fusee/common/log.h"
|
||||||
#include "../../../fusee/common/vsprintf.h"
|
#include "../../../fusee/common/vsprintf.h"
|
||||||
#include "../../../fusee/common/display/video_fb.h"
|
#include "../../../fusee/common/display/video_fb.h"
|
||||||
|
@ -37,6 +39,37 @@
|
||||||
#undef u8
|
#undef u8
|
||||||
#undef u32
|
#undef u32
|
||||||
|
|
||||||
|
static bool is_soc_mariko(void) {
|
||||||
|
return fuse_get_soc_type() == 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
__attribute__((noreturn)) static void shutdown_system(bool reboot) {
|
||||||
|
/* Ensure that i2c5 is in a coherent state. */
|
||||||
|
i2c_config(I2C_5);
|
||||||
|
clkrst_reboot(CARDEVICE_I2C5);
|
||||||
|
i2c_init(I2C_5);
|
||||||
|
|
||||||
|
/* Get value, set or clear software reset mask. */
|
||||||
|
uint8_t on_off_2_val = 0;
|
||||||
|
i2c_query(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG2, &on_off_2_val, 1);
|
||||||
|
if (reboot) {
|
||||||
|
on_off_2_val |= MAX77620_ONOFFCNFG2_SFT_RST_WK;
|
||||||
|
} else {
|
||||||
|
on_off_2_val &= ~(MAX77620_ONOFFCNFG2_SFT_RST_WK);
|
||||||
|
}
|
||||||
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG2, &on_off_2_val, 1);
|
||||||
|
|
||||||
|
/* Set software reset mask. */
|
||||||
|
uint8_t on_off_1_val = 0;
|
||||||
|
i2c_query(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG1, &on_off_1_val, 1);
|
||||||
|
on_off_1_val |= MAX77620_ONOFFCNFG1_SFT_RST;
|
||||||
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG1, &on_off_1_val, 1);
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
/* Wait for reboot. */
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
extern uint8_t __reboot_start__[], __reboot_end__[];
|
extern uint8_t __reboot_start__[], __reboot_end__[];
|
||||||
|
|
||||||
void wait(uint32_t microseconds) {
|
void wait(uint32_t microseconds) {
|
||||||
|
@ -70,43 +103,47 @@ __attribute__((noreturn)) void pmc_reboot(uint32_t scratch0) {
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) void reboot_to_self(void) {
|
__attribute__((noreturn)) void reboot_to_self(void) {
|
||||||
/* Patch SDRAM init to perform an SVC immediately after second write */
|
if (is_soc_mariko()) {
|
||||||
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
/* If mariko, we can't reboot to self/payload, so just reboot. */
|
||||||
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
shutdown_system(true);
|
||||||
/* Set SVC handler to jump to reboot stub in IRAM. */
|
} else {
|
||||||
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
/* Patch SDRAM init to perform an SVC immediately after second write */
|
||||||
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
||||||
|
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
||||||
|
/* Set SVC handler to jump to reboot stub in IRAM. */
|
||||||
|
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
||||||
|
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
||||||
|
|
||||||
/* Copy reboot stub into IRAM high. */
|
/* Copy reboot stub into IRAM high. */
|
||||||
for (size_t i = 0; i < rebootstub_bin_size; i += sizeof(uint32_t)) {
|
for (size_t i = 0; i < rebootstub_bin_size; i += sizeof(uint32_t)) {
|
||||||
write32le((void *)0x4003F000, i, read32le(rebootstub_bin, i));
|
write32le((void *)0x4003F000, i, read32le(rebootstub_bin, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Copy our low part into safe IRAM. */
|
||||||
|
for (size_t i = 0; i < 0x8000; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x40030000, i, read32le((void *)0x40008000, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Copy our start page into fatal IRAM. */
|
||||||
|
for (size_t i = 0; i < 0x1000; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x4003D000, i, read32le((void *)0x40010000, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Copy our reboot handler to the rebootstub target. */
|
||||||
|
for (size_t i = 0; i < (__reboot_end__ - __reboot_start__); i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x40010000, i, read32le(__reboot_start__, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Trigger warm reboot. */
|
||||||
|
APBDEV_PMC_SCRATCH0_0 = (1 << 0);
|
||||||
|
|
||||||
|
/* Reset the processor. */
|
||||||
|
APBDEV_PMC_CONTROL = BIT(4);
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
/* Wait for reboot. */
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Copy our low part into safe IRAM. */
|
|
||||||
for (size_t i = 0; i < 0x8000; i += sizeof(uint32_t)) {
|
|
||||||
write32le((void *)0x40030000, i, read32le((void *)0x40008000, i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Copy our start page into fatal IRAM. */
|
|
||||||
for (size_t i = 0; i < 0x1000; i += sizeof(uint32_t)) {
|
|
||||||
write32le((void *)0x4003D000, i, read32le((void *)0x40010000, i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Copy our reboot handler to the rebootstub target. */
|
|
||||||
for (size_t i = 0; i < (__reboot_end__ - __reboot_start__); i += sizeof(uint32_t)) {
|
|
||||||
write32le((void *)0x40010000, i, read32le(__reboot_start__, i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Trigger warm reboot. */
|
|
||||||
APBDEV_PMC_SCRATCH0_0 = (1 << 0);
|
|
||||||
|
|
||||||
/* Reset the processor. */
|
|
||||||
APBDEV_PMC_CONTROL = BIT(4);
|
|
||||||
|
|
||||||
while (true) {
|
|
||||||
/* Wait for reboot. */
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) void wait_for_button_and_reboot(void) {
|
__attribute__((noreturn)) void wait_for_button_and_reboot(void) {
|
||||||
|
|
|
@ -13,7 +13,7 @@
|
||||||
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
||||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
#include <stdarg.h>
|
#include <stdarg.h>
|
||||||
#include "utils.h"
|
#include "utils.h"
|
||||||
|
@ -23,7 +23,9 @@
|
||||||
#include "car.h"
|
#include "car.h"
|
||||||
#include "timers.h"
|
#include "timers.h"
|
||||||
#include "btn.h"
|
#include "btn.h"
|
||||||
|
#include "i2c.h"
|
||||||
#include "panic.h"
|
#include "panic.h"
|
||||||
|
#include "max77620.h"
|
||||||
#include "../../../fusee/common/log.h"
|
#include "../../../fusee/common/log.h"
|
||||||
|
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
|
@ -37,6 +39,37 @@
|
||||||
#undef u8
|
#undef u8
|
||||||
#undef u32
|
#undef u32
|
||||||
|
|
||||||
|
static bool is_soc_mariko(void) {
|
||||||
|
return fuse_get_soc_type() == 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
__attribute__((noreturn)) static void shutdown_system(bool reboot) {
|
||||||
|
/* Ensure that i2c5 is in a coherent state. */
|
||||||
|
i2c_config(I2C_5);
|
||||||
|
clkrst_reboot(CARDEVICE_I2C5);
|
||||||
|
i2c_init(I2C_5);
|
||||||
|
|
||||||
|
/* Get value, set or clear software reset mask. */
|
||||||
|
uint8_t on_off_2_val = 0;
|
||||||
|
i2c_query(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG2, &on_off_2_val, 1);
|
||||||
|
if (reboot) {
|
||||||
|
on_off_2_val |= MAX77620_ONOFFCNFG2_SFT_RST_WK;
|
||||||
|
} else {
|
||||||
|
on_off_2_val &= ~(MAX77620_ONOFFCNFG2_SFT_RST_WK);
|
||||||
|
}
|
||||||
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG2, &on_off_2_val, 1);
|
||||||
|
|
||||||
|
/* Set software reset mask. */
|
||||||
|
uint8_t on_off_1_val = 0;
|
||||||
|
i2c_query(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG1, &on_off_1_val, 1);
|
||||||
|
on_off_1_val |= MAX77620_ONOFFCNFG1_SFT_RST;
|
||||||
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_ONOFFCNFG1, &on_off_1_val, 1);
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
/* Wait for reboot. */
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void wait(uint32_t microseconds) {
|
void wait(uint32_t microseconds) {
|
||||||
uint32_t old_time = TIMERUS_CNTR_1US_0;
|
uint32_t old_time = TIMERUS_CNTR_1US_0;
|
||||||
while (TIMERUS_CNTR_1US_0 - old_time <= microseconds) {
|
while (TIMERUS_CNTR_1US_0 - old_time <= microseconds) {
|
||||||
|
@ -67,21 +100,26 @@ __attribute__((noreturn)) void pmc_reboot(uint32_t scratch0) {
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) static void reboot_to_payload(void) {
|
__attribute__((noreturn)) static void reboot_to_payload(void) {
|
||||||
/* Patch SDRAM init to perform an SVC immediately after second write */
|
if (is_soc_mariko()) {
|
||||||
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
/* Reboot to payload isn't possible on mariko, so just do normal reboot. */
|
||||||
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
shutdown_system(true);
|
||||||
/* Set SVC handler to jump to reboot stub in IRAM. */
|
} else {
|
||||||
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
/* Patch SDRAM init to perform an SVC immediately after second write */
|
||||||
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
||||||
|
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
||||||
/* Copy reboot stub into IRAM high. */
|
/* Set SVC handler to jump to reboot stub in IRAM. */
|
||||||
for (size_t i = 0; i < rebootstub_bin_size; i += sizeof(uint32_t)) {
|
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
||||||
write32le((void *)0x4003F000, i, read32le(rebootstub_bin, i));
|
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
||||||
|
|
||||||
|
/* Copy reboot stub into IRAM high. */
|
||||||
|
for (size_t i = 0; i < rebootstub_bin_size; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x4003F000, i, read32le(rebootstub_bin, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Trigger warm reboot. */
|
||||||
|
pmc_reboot(1 << 0);
|
||||||
|
while (true) { }
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Trigger warm reboot. */
|
|
||||||
pmc_reboot(1 << 0);
|
|
||||||
while (true) { }
|
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) void reboot_to_fusee_primary(void) {
|
__attribute__((noreturn)) void reboot_to_fusee_primary(void) {
|
||||||
|
@ -89,38 +127,42 @@ __attribute__((noreturn)) void reboot_to_fusee_primary(void) {
|
||||||
for (size_t i = 0; i < fusee_primary_bin_size; i += sizeof(uint32_t)) {
|
for (size_t i = 0; i < fusee_primary_bin_size; i += sizeof(uint32_t)) {
|
||||||
write32le((void *)0x40010000, i, read32le(fusee_primary_bin, i));
|
write32le((void *)0x40010000, i, read32le(fusee_primary_bin, i));
|
||||||
}
|
}
|
||||||
|
|
||||||
reboot_to_payload();
|
reboot_to_payload();
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) void reboot_to_sept(const void *tsec_fw, size_t tsec_fw_length, const void *stage2, size_t stage2_size) {
|
__attribute__((noreturn)) void reboot_to_sept(const void *tsec_fw, size_t tsec_fw_length, const void *stage2, size_t stage2_size) {
|
||||||
|
if (is_soc_mariko()) {
|
||||||
/* Copy tsec firmware. */
|
/* Reboot to sept isn't possible on mariko, so just do normal reboot. */
|
||||||
for (size_t i = 0; i < tsec_fw_length; i += sizeof(uint32_t)) {
|
shutdown_system(true);
|
||||||
write32le((void *)0x40010F00, i, read32le(tsec_fw, i));
|
} else {
|
||||||
|
/* Copy tsec firmware. */
|
||||||
|
for (size_t i = 0; i < tsec_fw_length; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x40010F00, i, read32le(tsec_fw, i));
|
||||||
|
}
|
||||||
|
MAKE_REG32(0x40010EFC) = tsec_fw_length;
|
||||||
|
|
||||||
|
/* Copy stage 2. */
|
||||||
|
for (size_t i = 0; i < stage2_size; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x40016FE0, i, read32le(stage2, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Copy sept into IRAM low. */
|
||||||
|
for (size_t i = 0; i < sept_primary_bin_size; i += sizeof(uint32_t)) {
|
||||||
|
write32le((void *)0x4003F000, i, read32le(sept_primary_bin, i));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Patch SDRAM init to perform an SVC immediately after second write */
|
||||||
|
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
||||||
|
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
||||||
|
/* Set SVC handler to jump to reboot stub in IRAM. */
|
||||||
|
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
||||||
|
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
||||||
|
|
||||||
|
/* Trigger warm reboot. */
|
||||||
|
pmc_reboot(1 << 0);
|
||||||
|
while (true) { }
|
||||||
}
|
}
|
||||||
MAKE_REG32(0x40010EFC) = tsec_fw_length;
|
|
||||||
|
|
||||||
/* Copy stage 2. */
|
|
||||||
for (size_t i = 0; i < stage2_size; i += sizeof(uint32_t)) {
|
|
||||||
write32le((void *)0x40016FE0, i, read32le(stage2, i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Copy sept into IRAM low. */
|
|
||||||
for (size_t i = 0; i < sept_primary_bin_size; i += sizeof(uint32_t)) {
|
|
||||||
write32le((void *)0x4003F000, i, read32le(sept_primary_bin, i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Patch SDRAM init to perform an SVC immediately after second write */
|
|
||||||
APBDEV_PMC_SCRATCH45_0 = 0x2E38DFFF;
|
|
||||||
APBDEV_PMC_SCRATCH46_0 = 0x6001DC28;
|
|
||||||
/* Set SVC handler to jump to reboot stub in IRAM. */
|
|
||||||
APBDEV_PMC_SCRATCH33_0 = 0x4003F000;
|
|
||||||
APBDEV_PMC_SCRATCH40_0 = 0x6000F208;
|
|
||||||
|
|
||||||
/* Trigger warm reboot. */
|
|
||||||
pmc_reboot(1 << 0);
|
|
||||||
while (true) { }
|
|
||||||
}
|
}
|
||||||
|
|
||||||
__attribute__((noreturn)) void reboot_to_iram_payload(void *payload, size_t payload_size) {
|
__attribute__((noreturn)) void reboot_to_iram_payload(void *payload, size_t payload_size) {
|
||||||
|
@ -128,7 +170,7 @@ __attribute__((noreturn)) void reboot_to_iram_payload(void *payload, size_t payl
|
||||||
for (size_t i = 0; i < payload_size; i += sizeof(uint32_t)) {
|
for (size_t i = 0; i < payload_size; i += sizeof(uint32_t)) {
|
||||||
write32le((void *)0x40010000, i, read32le(payload, i));
|
write32le((void *)0x40010000, i, read32le(payload, i));
|
||||||
}
|
}
|
||||||
|
|
||||||
reboot_to_payload();
|
reboot_to_payload();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -159,7 +201,7 @@ __attribute__ ((noreturn)) void generic_panic(void) {
|
||||||
__attribute__((noreturn)) void fatal_error(const char *fmt, ...) {
|
__attribute__((noreturn)) void fatal_error(const char *fmt, ...) {
|
||||||
/* Override the global logging level. */
|
/* Override the global logging level. */
|
||||||
log_set_log_level(SCREEN_LOG_LEVEL_ERROR);
|
log_set_log_level(SCREEN_LOG_LEVEL_ERROR);
|
||||||
|
|
||||||
/* Display fatal error. */
|
/* Display fatal error. */
|
||||||
va_list args;
|
va_list args;
|
||||||
print(SCREEN_LOG_LEVEL_ERROR, "Fatal error: ");
|
print(SCREEN_LOG_LEVEL_ERROR, "Fatal error: ");
|
||||||
|
@ -167,7 +209,7 @@ __attribute__((noreturn)) void fatal_error(const char *fmt, ...) {
|
||||||
vprint(SCREEN_LOG_LEVEL_ERROR, fmt, args);
|
vprint(SCREEN_LOG_LEVEL_ERROR, fmt, args);
|
||||||
va_end(args);
|
va_end(args);
|
||||||
print(SCREEN_LOG_LEVEL_ERROR | SCREEN_LOG_LEVEL_NO_PREFIX, "\n Press POWER to reboot.\n");
|
print(SCREEN_LOG_LEVEL_ERROR | SCREEN_LOG_LEVEL_NO_PREFIX, "\n Press POWER to reboot.\n");
|
||||||
|
|
||||||
/* Wait for button and reboot. */
|
/* Wait for button and reboot. */
|
||||||
wait_for_button_and_reboot();
|
wait_for_button_and_reboot();
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue