You've already forked pico-loader
mirror of
https://github.com/LNH-team/pico-loader.git
synced 2026-01-09 16:28:35 -08:00
50 lines
1.0 KiB
ArmAsm
50 lines
1.0 KiB
ArmAsm
.cpu arm7tdmi
|
|
.section "saveoffsettosdsector", "ax"
|
|
.syntax unified
|
|
.thumb
|
|
|
|
// r0 = save offset
|
|
// returns sd sector in r0
|
|
// returns cluster shift in r1
|
|
// returns remaining sectors in cluster in lr
|
|
.global save_offset_to_sd_sector_asm
|
|
.type save_offset_to_sd_sector_asm, %function
|
|
save_offset_to_sd_sector_asm:
|
|
push {r4,r5,lr}
|
|
retry:
|
|
ldr r5, saveoffsettosdsector_fatDataPtr
|
|
ldmia r5!, {r1,r2,r3,r4} // clusterShift, database, clusterMask, clusterMap[0]
|
|
lsrs r0, r0, #9
|
|
adds r4, r3, #1
|
|
ands r3, r0
|
|
subs r4, r3
|
|
mov lr, r4 // remaining sectors in cluster
|
|
adds r3, r2
|
|
lsrs r0, r1 // cl
|
|
1:
|
|
ldmia r5!, {r2,r4} // ncl, startSector
|
|
cmp r2, #0
|
|
beq out_of_bounds
|
|
subs r0, r2 // cl -= ncl
|
|
bcs 1b
|
|
|
|
adds r0, r2
|
|
adds r0, r4 // + startSector
|
|
subs r0, #2 // - 2
|
|
lsls r0, r1
|
|
adds r0, r3 // r0 = src sector
|
|
pop {r4,r5,pc}
|
|
|
|
out_of_bounds:
|
|
movs r0, #0
|
|
pop {r4,r5,pc}
|
|
|
|
.balign 4
|
|
|
|
.global saveoffsettosdsector_fatDataPtr
|
|
saveoffsettosdsector_fatDataPtr:
|
|
.word 0x027FFA00
|
|
|
|
.pool
|
|
|
|
.end |