lib/ultralib/src/io/contchannelreset.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

#include "PR/os_internal.h"
#include "PRinternal/controller.h"
#include "PRinternal/siint.h"

s32 __osContChannelReset(OSMesgQueue* mq, int channel) {
    s32 i;
    s32 ret;
    u8* ptr = (u8*)&__osPfsPifRam;

    __osSiGetAccess();
    __osPfsPifRam.pifstatus = CONT_CMD_EXE;

    for (i = 0; i < channel; i++) {
        *ptr++ = CONT_CMD_REQUEST_STATUS;
    }

    *ptr++ = CONT_CMD_CHANNEL_RESET;
    *ptr = CONT_CMD_END;

    ret = __osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
    osRecvMesg(mq, NULL, OS_MESG_BLOCK);

    ret = __osSiRawStartDma(OS_READ, &__osPfsPifRam);
    osRecvMesg(mq, NULL, OS_MESG_BLOCK);

    __osSiRelAccess();
    return ret;
}