src/libleo/api/bytetolba.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44

#include "ultra64.h"
#include "ultra64/leo.h"
#include "ultra64/leoappli.h"
#include "ultra64/leodrive.h"

s32 LeoByteToLBA(s32 startlba, u32 nbytes, s32* lba) {
    u32 reslba;
    u32 byte_p_blk;
    u16 zone;
    u16 vzone;
    u8 flag;

    if (!__leoActive) {
        return -1;
    }

    reslba = 0;
    flag = vzone = 1;
    startlba += 0x18;
    while (nbytes != 0) {
        if ((flag != 0) || (LEOVZONE_TBL[LEOdisk_type][vzone] == startlba)) {
            vzone = leoLba_to_vzone(startlba);
            zone = LEOVZONE_PZONEHD_TBL[LEOdisk_type][vzone];
            if (zone >= 8) {
                zone -= 7;
            }
            byte_p_blk = LEOBYTE_TBL2[zone];
        }
        if (nbytes < byte_p_blk) {
            nbytes = 0;
        } else {
            nbytes -= byte_p_blk;
        }
        reslba++;
        startlba++;
        if ((nbytes != 0) && ((u32)startlba >= NUM_LBAS + 0x18)) {
            return LEO_ERROR_LBA_OUT_OF_RANGE;
        }
        flag = 0;
    }

    *lba = reslba;
    return LEO_ERROR_GOOD;
}