lib/ultralib/src/voice/voicecheckresult.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 "io/controller.h"
#include "PR/os_voice.h"
#include "voiceinternal.h"

s32 __osVoiceCheckResult(OSVoiceHandle* hd, u8* stat) {
    s32 ret;
    u8 buf[2];

    ret = __osVoiceGetStatus(hd->__mq, hd->__channel, stat);
    if (ret == 0) {
        if (*stat & 1) {
            ret = CONT_ERR_VOICE_NO_RESPONSE;
        } else {
            ret = __osVoiceContRead2(hd->__mq, hd->__channel, 0, buf);
            if (ret == 0) {
                hd->cmd_status = buf[0] & 7;

                if (buf[0] & 0x40) {
                    ret = CONT_ERR_VOICE_NO_RESPONSE;
                } else {
                    ret = buf[1] << 8;
                }
            }
        }
    }
    return ret;
}