libexo/sc7fw: support release/debug/audit

This commit is contained in:
Michael Scire 2020-11-14 12:17:38 -08:00
parent f74527d93c
commit 71a38ae74d
14 changed files with 413 additions and 47 deletions

View file

@ -155,6 +155,106 @@ signed __aeabi_idivmod(signed numerator, signed denominator)
return ret_idivmod_values(qr.q, qr.r);
}
/* struct lqr - stores qutient/remainder to handle divmod EABI interfaces. */
struct lqr {
unsigned long long q; /* computed quotient */
unsigned long long r; /* computed remainder */
unsigned q_n; /* specficies if quotient shall be negative */
unsigned r_n; /* specficies if remainder shall be negative */
};
static void ul_div_qr(unsigned long long numerator,
unsigned long long denominator, struct lqr *qr);
static void division_lqr(unsigned long long n, unsigned long long p,
struct lqr *qr)
{
unsigned long long i = 1, q = 0;
if (p == 0) {
qr->r = 0xFFFFFFFFFFFFFFFFULL; /* division by 0 */
return;
}
while ((p >> 63) == 0) {
i = i << 1; /* count the max division steps */
p = p << 1; /* increase p until it has maximum size*/
}
while (i > 0) {
q = q << 1; /* write bit in q at index (size-1) */
if (n >= p) {
n -= p;
q++;
}
p = p >> 1; /* decrease p */
i = i >> 1; /* decrease remaining size in q */
}
qr->r = n;
qr->q = q;
}
static void ul_div_qr(unsigned long long numerator,
unsigned long long denominator, struct lqr *qr)
{
division_lqr(numerator, denominator, qr);
/* negate quotient and/or remainder according to requester */
if (qr->q_n)
qr->q = -qr->q;
if (qr->r_n)
qr->r = -qr->r;
}
struct asm_ulqr {
unsigned long long v0;
unsigned long long v1;
};
/* called from assembly function __aeabi_uldivmod */
void __ul_divmod(struct asm_ulqr *asm_ulqr);
void __ul_divmod(struct asm_ulqr *asm_ulqr)
{
unsigned long long numerator = asm_ulqr->v0;
unsigned long long denominator = asm_ulqr->v1;
struct lqr qr = { .q_n = 0, .r_n = 0 };
ul_div_qr(numerator, denominator, &qr);
asm_ulqr->v0 = qr.q;
asm_ulqr->v1 = qr.r;
}
struct asm_lqr {
long long v0;
long long v1;
};
/* called from assembly function __aeabi_ldivmod */
void __l_divmod(struct asm_lqr *asm_lqr);
void __l_divmod(struct asm_lqr *asm_lqr)
{
long long numerator = asm_lqr->v0;
long long denominator = asm_lqr->v1;
struct lqr qr = { .q_n = 0, .r_n = 0 };
if (((numerator < 0) && (denominator > 0)) ||
((numerator > 0) && (denominator < 0)))
qr.q_n = 1; /* quotient shall be negate */
if (numerator < 0) {
numerator = -numerator;
qr.r_n = 1; /* remainder shall be negate */
}
if (denominator < 0)
denominator = -denominator;
ul_div_qr(numerator, denominator, &qr);
asm_lqr->v0 = qr.q;
asm_lqr->v1 = qr.r;
}
#ifdef __cplusplus
} /* extern "C" */
#endif

View file

@ -28,3 +28,40 @@ ret_uidivmod_values:
bx lr
.type ret_uidivmod_values, %function
.size ret_uidivmod_values, .-ret_uidivmod_values
/*
* __value_in_regs lldiv_t __aeabi_ldivmod( long long n, long long d)
*/
.section .text.__aeabi_ldivmod, "ax", %progbits
.globl __aeabi_ldivmod
.align 0
.syntax unified
__aeabi_ldivmod:
push {ip, lr}
push {r0-r3}
mov r0, sp
bl __l_divmod
pop {r0-r3}
pop {ip, pc}
.type __aeabi_ldivmod, %function
.size __aeabi_ldivmod, .-__aeabi_ldivmod
/*
* __value_in_regs ulldiv_t __aeabi_uldivmod(
* unsigned long long n, unsigned long long d)
*/
.section .text.__aeabi_uldivmod , "ax", %progbits
.globl __aeabi_uldivmod
.align 0
.syntax unified
__aeabi_uldivmod :
push {ip, lr}
push {r0-r3}
mov r0, sp
bl __ul_divmod
pop {r0-r3}
pop {ip, pc}
.type __aeabi_uldivmod, %function
.size __aeabi_uldivmod, .-__aeabi_uldivmod

View file

@ -33,3 +33,22 @@ __gnu_thumb1_case_uqi:
bx lr
.type __gnu_thumb1_case_uqi, %function
.size __gnu_thumb1_case_uqi, .-__gnu_thumb1_case_uqi
.section .text.__gnu_thumb1_case_uhi, "ax", %progbits
.globl __gnu_thumb1_case_uhi
.align 0
.thumb_func
.syntax unified
__gnu_thumb1_case_uhi:
push {r0, r1}
mov r1, lr
lsrs r1, r1, #1
lsls r0, r0, #1
lsls r1, r1, #1
ldrh r1, [r1, r0]
lsls r1, r1, #1
add lr, lr, r1
pop {r0, r1}
bx lr
.type __gnu_thumb1_case_uhi, %function
.size __gnu_thumb1_case_uhi, .-__gnu_thumb1_case_uhi

View file

@ -20,8 +20,8 @@ namespace ams::log {
namespace {
constexpr inline uart::Port UartLogPort = uart::Port_ReservedDebug;
constexpr inline int UartBaudRate = 115200;
constinit bool g_initialized_uart = false;
constinit bool g_logging_enabled = false;
constexpr inline u32 UartPortFlags = [] {
if constexpr (UartLogPort == uart::Port_ReservedDebug) {
@ -78,20 +78,51 @@ namespace ams::log {
g_initialized_uart = false;
}
void SetDebugLogEnabled(bool en) {
g_logging_enabled = en;
NOINLINE void VPrintf(const char *fmt, ::std::va_list vl) {
/* TODO: What's a good size for the log buffer? Nintendo uses 0x100, but this seems big. */
char log_buf[0x80];
const auto len = util::TVSNPrintf(log_buf, sizeof(log_buf), fmt, vl);
if (g_initialized_uart) {
uart::SendText(UartLogPort, log_buf, len);
}
}
NOINLINE void Printf(const char *fmt, ...) {
::std::va_list vl;
va_start(vl, fmt);
VPrintf(fmt, vl);
va_end(vl);
}
NOINLINE void Dump(const void *src, size_t size) {
const u8 *src_u8 = static_cast<const u8 *>(src);
for (size_t i = 0; i < size; ++i) {
if ((i % 0x20) == 0x00) {
Printf("%03zx| ", i);
}
Printf("%02x ", src_u8[i]);
if ((i % 0x20) == 0x1F) {
Printf("\n");
}
}
if ((size % 0x20) != 0) {
Printf("\n");
}
}
void SendText(const void *text, size_t size) {
if (g_initialized_uart && g_logging_enabled) {
if (g_initialized_uart) {
uart::SendText(UartLogPort, text, size);
}
}
void Flush() {
if (g_initialized_uart && g_logging_enabled) {
if (g_initialized_uart) {
uart::WaitFlush(UartLogPort);
}
}
}
}