lib/ultralib/src/voice/voicemaskdictionary.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
45
46
47
48

#include "PR/os_internal.h"
#include "io/controller.h"
#include "PR/os_voice.h"
#include "voiceinternal.h"

s32 osVoiceMaskDictionary(OSVoiceHandle* hd, u8* pattern, int size) {
    s32 ret = 0;
    s32 i;
    s32 j;
    u8 stat;
    u8 buf[20];

    ret = __osVoiceGetStatus(hd->__mq, hd->__channel, &stat);
    if (ret != 0) {
        return ret;
    } else if (stat & 2) {
        return CONT_ERR_VOICE_NO_RESPONSE;
    }

    if (size & 1) {
        j = size + 1;
    } else {
        j = size;
    }

    bzero(&buf, ARRLEN(buf));

    buf[18 - j] = 4;

    for (i = 0; i < j; i += 2) {
        buf[i + ARRLEN(buf) - j] = pattern[i];
        buf[i + ARRLEN(buf) - j + 1] = pattern[i + 1];
    }

    if (size & 1) {
        buf[ARRLEN(buf) - 1] = 0;
    }

    ret = __osVoiceContWrite20(hd->__mq, hd->__channel, 0, (u8*)&buf);
    if (ret == 0) {
        ret = __osVoiceCheckResult(hd, &stat);
        if (ret & 0xFF00) {
            ret = CONT_ERR_INVALID;
        }
    }

    return ret;
}