summaryrefslogtreecommitdiff
path: root/lib/ultralib/src/io/gbpakreadwrite.c
blob: fe16ee2b503906a6151f5a017d6bfc40b54fdedd (plain)
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
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
#include "PR/os_internal.h"
#include "PRinternal/controller.h"
#include "os_version.h"

s32 __osGbpakSetBank(OSPfs* pfs, u8 bank);

s32 osGbpakReadWrite(OSPfs* pfs, u16 flag, u16 address, u8* buffer, u16 size) {
    s32 i;
    s32 ret;
    u8 bank;

    bank = (u8)(address >> 0xE);

    if (bank != pfs->banks) {
        ret = __osGbpakSetBank(pfs, bank);

        if (ret != 0) {
            return ret;
        }
    }

#if BUILD_VERSION >= VERSION_K
    if (size == 0) {
        return 0;
    }
#endif

    size = (u16)(size >> 5);
    address = (u16)((address | 0xC000) >> 5);

    if (flag == 1) {
        for (i = 0; i < (s32)size; i++, buffer += BLOCKSIZE) {
            ret = __osContRamWrite(pfs->queue, pfs->channel, address, buffer, 0);

            if (ret != 0) {
                break;
            }

            if ((++address >= 0x800) && (i < (s32)(size - 1))) {
                ret = __osGbpakSetBank(pfs, ++bank);

                if (ret != 0) {
                    break;
                }

                address = 0x600U;
            }
        }
    } else {
        for (i = 0; i < (s32)size; i++, buffer += BLOCKSIZE) {
            ret = __osContRamRead(pfs->queue, pfs->channel, address, buffer);

            if (ret != 0) {
                break;
            }

            if (++address >= 0x800 && (i < (s32)(size - 1))) {
                ret = __osGbpakSetBank(pfs, ++bank);

                if (ret != 0) {
                    break;
                }

                address = 0x600U;
            }
        }
    }

    if (ret == PFS_ERR_NEW_PACK) {
        ret = PFS_ERR_CONTRFAIL;
    }

    return ret;
}