mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2025-05-29 22:15:17 -04:00
libexo/sc7fw: support release/debug/audit
This commit is contained in:
parent
f74527d93c
commit
71a38ae74d
14 changed files with 413 additions and 47 deletions
|
@ -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
|
|
@ -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
|
||||
|
|
|
@ -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
|
||||
|
|
|
@ -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);
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue