1cabdff1aSopenharmony_ci/*
2cabdff1aSopenharmony_ci * Westwood SNDx codecs
3cabdff1aSopenharmony_ci * Copyright (c) 2005 Konstantin Shishkov
4cabdff1aSopenharmony_ci *
5cabdff1aSopenharmony_ci * This file is part of FFmpeg.
6cabdff1aSopenharmony_ci *
7cabdff1aSopenharmony_ci * FFmpeg is free software; you can redistribute it and/or
8cabdff1aSopenharmony_ci * modify it under the terms of the GNU Lesser General Public
9cabdff1aSopenharmony_ci * License as published by the Free Software Foundation; either
10cabdff1aSopenharmony_ci * version 2.1 of the License, or (at your option) any later version.
11cabdff1aSopenharmony_ci *
12cabdff1aSopenharmony_ci * FFmpeg is distributed in the hope that it will be useful,
13cabdff1aSopenharmony_ci * but WITHOUT ANY WARRANTY; without even the implied warranty of
14cabdff1aSopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15cabdff1aSopenharmony_ci * Lesser General Public License for more details.
16cabdff1aSopenharmony_ci *
17cabdff1aSopenharmony_ci * You should have received a copy of the GNU Lesser General Public
18cabdff1aSopenharmony_ci * License along with FFmpeg; if not, write to the Free Software
19cabdff1aSopenharmony_ci * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20cabdff1aSopenharmony_ci */
21cabdff1aSopenharmony_ci
22cabdff1aSopenharmony_ci#include <stdint.h>
23cabdff1aSopenharmony_ci
24cabdff1aSopenharmony_ci#include "libavutil/channel_layout.h"
25cabdff1aSopenharmony_ci#include "libavutil/common.h"
26cabdff1aSopenharmony_ci#include "libavutil/intreadwrite.h"
27cabdff1aSopenharmony_ci#include "avcodec.h"
28cabdff1aSopenharmony_ci#include "codec_internal.h"
29cabdff1aSopenharmony_ci#include "internal.h"
30cabdff1aSopenharmony_ci
31cabdff1aSopenharmony_ci/**
32cabdff1aSopenharmony_ci * @file
33cabdff1aSopenharmony_ci * Westwood SNDx codecs
34cabdff1aSopenharmony_ci *
35cabdff1aSopenharmony_ci * Reference documents about VQA format and its audio codecs
36cabdff1aSopenharmony_ci * can be found here:
37cabdff1aSopenharmony_ci * http://www.multimedia.cx
38cabdff1aSopenharmony_ci */
39cabdff1aSopenharmony_ci
40cabdff1aSopenharmony_cistatic const int8_t ws_adpcm_4bit[] = {
41cabdff1aSopenharmony_ci    -9, -8, -6, -5, -4, -3, -2, -1,
42cabdff1aSopenharmony_ci     0,  1,  2,  3,  4,  5,  6,  8
43cabdff1aSopenharmony_ci};
44cabdff1aSopenharmony_ci
45cabdff1aSopenharmony_cistatic av_cold int ws_snd_decode_init(AVCodecContext *avctx)
46cabdff1aSopenharmony_ci{
47cabdff1aSopenharmony_ci    av_channel_layout_uninit(&avctx->ch_layout);
48cabdff1aSopenharmony_ci    avctx->ch_layout      = (AVChannelLayout)AV_CHANNEL_LAYOUT_MONO;
49cabdff1aSopenharmony_ci    avctx->sample_fmt     = AV_SAMPLE_FMT_U8;
50cabdff1aSopenharmony_ci
51cabdff1aSopenharmony_ci    return 0;
52cabdff1aSopenharmony_ci}
53cabdff1aSopenharmony_ci
54cabdff1aSopenharmony_cistatic int ws_snd_decode_frame(AVCodecContext *avctx, AVFrame *frame,
55cabdff1aSopenharmony_ci                               int *got_frame_ptr, AVPacket *avpkt)
56cabdff1aSopenharmony_ci{
57cabdff1aSopenharmony_ci    const uint8_t *buf = avpkt->data;
58cabdff1aSopenharmony_ci    int buf_size       = avpkt->size;
59cabdff1aSopenharmony_ci
60cabdff1aSopenharmony_ci    int in_size, out_size, ret;
61cabdff1aSopenharmony_ci    int sample = 128;
62cabdff1aSopenharmony_ci    uint8_t *samples;
63cabdff1aSopenharmony_ci    uint8_t *samples_end;
64cabdff1aSopenharmony_ci
65cabdff1aSopenharmony_ci    if (!buf_size)
66cabdff1aSopenharmony_ci        return 0;
67cabdff1aSopenharmony_ci
68cabdff1aSopenharmony_ci    if (buf_size < 4) {
69cabdff1aSopenharmony_ci        av_log(avctx, AV_LOG_ERROR, "packet is too small\n");
70cabdff1aSopenharmony_ci        return AVERROR(EINVAL);
71cabdff1aSopenharmony_ci    }
72cabdff1aSopenharmony_ci
73cabdff1aSopenharmony_ci    out_size = AV_RL16(&buf[0]);
74cabdff1aSopenharmony_ci    in_size  = AV_RL16(&buf[2]);
75cabdff1aSopenharmony_ci    buf += 4;
76cabdff1aSopenharmony_ci
77cabdff1aSopenharmony_ci    if (in_size > buf_size) {
78cabdff1aSopenharmony_ci        av_log(avctx, AV_LOG_ERROR, "Frame data is larger than input buffer\n");
79cabdff1aSopenharmony_ci        return AVERROR_INVALIDDATA;
80cabdff1aSopenharmony_ci    }
81cabdff1aSopenharmony_ci
82cabdff1aSopenharmony_ci    /* get output buffer */
83cabdff1aSopenharmony_ci    frame->nb_samples = out_size;
84cabdff1aSopenharmony_ci    if ((ret = ff_get_buffer(avctx, frame, 0)) < 0)
85cabdff1aSopenharmony_ci        return ret;
86cabdff1aSopenharmony_ci    samples     = frame->data[0];
87cabdff1aSopenharmony_ci    samples_end = samples + out_size;
88cabdff1aSopenharmony_ci
89cabdff1aSopenharmony_ci    if (in_size == out_size) {
90cabdff1aSopenharmony_ci        memcpy(samples, buf, out_size);
91cabdff1aSopenharmony_ci        *got_frame_ptr = 1;
92cabdff1aSopenharmony_ci        return buf_size;
93cabdff1aSopenharmony_ci    }
94cabdff1aSopenharmony_ci
95cabdff1aSopenharmony_ci    while (samples < samples_end && buf - avpkt->data < buf_size) {
96cabdff1aSopenharmony_ci        int code, smp, size;
97cabdff1aSopenharmony_ci        uint8_t count;
98cabdff1aSopenharmony_ci        code  = *buf >> 6;
99cabdff1aSopenharmony_ci        count = *buf & 0x3F;
100cabdff1aSopenharmony_ci        buf++;
101cabdff1aSopenharmony_ci
102cabdff1aSopenharmony_ci        /* make sure we don't write past the output buffer */
103cabdff1aSopenharmony_ci        switch (code) {
104cabdff1aSopenharmony_ci        case 0:  smp = 4 * (count + 1);                break;
105cabdff1aSopenharmony_ci        case 1:  smp = 2 * (count + 1);                break;
106cabdff1aSopenharmony_ci        case 2:  smp = (count & 0x20) ? 1 : count + 1; break;
107cabdff1aSopenharmony_ci        default: smp = count + 1;                      break;
108cabdff1aSopenharmony_ci        }
109cabdff1aSopenharmony_ci        if (samples_end - samples < smp)
110cabdff1aSopenharmony_ci            break;
111cabdff1aSopenharmony_ci
112cabdff1aSopenharmony_ci        /* make sure we don't read past the input buffer */
113cabdff1aSopenharmony_ci        size = ((code == 2 && (count & 0x20)) || code == 3) ? 0 : count + 1;
114cabdff1aSopenharmony_ci        if ((buf - avpkt->data) + size > buf_size)
115cabdff1aSopenharmony_ci            break;
116cabdff1aSopenharmony_ci
117cabdff1aSopenharmony_ci        switch (code) {
118cabdff1aSopenharmony_ci        case 0: /* ADPCM 2-bit */
119cabdff1aSopenharmony_ci            for (count++; count > 0; count--) {
120cabdff1aSopenharmony_ci                code = *buf++;
121cabdff1aSopenharmony_ci                sample += ( code       & 0x3) - 2;
122cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
123cabdff1aSopenharmony_ci                *samples++ = sample;
124cabdff1aSopenharmony_ci                sample += ((code >> 2) & 0x3) - 2;
125cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
126cabdff1aSopenharmony_ci                *samples++ = sample;
127cabdff1aSopenharmony_ci                sample += ((code >> 4) & 0x3) - 2;
128cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
129cabdff1aSopenharmony_ci                *samples++ = sample;
130cabdff1aSopenharmony_ci                sample +=  (code >> 6)        - 2;
131cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
132cabdff1aSopenharmony_ci                *samples++ = sample;
133cabdff1aSopenharmony_ci            }
134cabdff1aSopenharmony_ci            break;
135cabdff1aSopenharmony_ci        case 1: /* ADPCM 4-bit */
136cabdff1aSopenharmony_ci            for (count++; count > 0; count--) {
137cabdff1aSopenharmony_ci                code = *buf++;
138cabdff1aSopenharmony_ci                sample += ws_adpcm_4bit[code & 0xF];
139cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
140cabdff1aSopenharmony_ci                *samples++ = sample;
141cabdff1aSopenharmony_ci                sample += ws_adpcm_4bit[code >> 4];
142cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
143cabdff1aSopenharmony_ci                *samples++ = sample;
144cabdff1aSopenharmony_ci            }
145cabdff1aSopenharmony_ci            break;
146cabdff1aSopenharmony_ci        case 2: /* no compression */
147cabdff1aSopenharmony_ci            if (count & 0x20) { /* big delta */
148cabdff1aSopenharmony_ci                int8_t t;
149cabdff1aSopenharmony_ci                t = count;
150cabdff1aSopenharmony_ci                t <<= 3;
151cabdff1aSopenharmony_ci                sample += t >> 3;
152cabdff1aSopenharmony_ci                sample = av_clip_uint8(sample);
153cabdff1aSopenharmony_ci                *samples++ = sample;
154cabdff1aSopenharmony_ci            } else { /* copy */
155cabdff1aSopenharmony_ci                memcpy(samples, buf, smp);
156cabdff1aSopenharmony_ci                samples += smp;
157cabdff1aSopenharmony_ci                buf     += smp;
158cabdff1aSopenharmony_ci                sample = buf[-1];
159cabdff1aSopenharmony_ci            }
160cabdff1aSopenharmony_ci            break;
161cabdff1aSopenharmony_ci        default: /* run */
162cabdff1aSopenharmony_ci            memset(samples, sample, smp);
163cabdff1aSopenharmony_ci            samples += smp;
164cabdff1aSopenharmony_ci        }
165cabdff1aSopenharmony_ci    }
166cabdff1aSopenharmony_ci
167cabdff1aSopenharmony_ci    frame->nb_samples = samples - frame->data[0];
168cabdff1aSopenharmony_ci    *got_frame_ptr    = 1;
169cabdff1aSopenharmony_ci
170cabdff1aSopenharmony_ci    return buf_size;
171cabdff1aSopenharmony_ci}
172cabdff1aSopenharmony_ci
173cabdff1aSopenharmony_ciconst FFCodec ff_ws_snd1_decoder = {
174cabdff1aSopenharmony_ci    .p.name         = "ws_snd1",
175cabdff1aSopenharmony_ci    .p.long_name    = NULL_IF_CONFIG_SMALL("Westwood Audio (SND1)"),
176cabdff1aSopenharmony_ci    .p.type         = AVMEDIA_TYPE_AUDIO,
177cabdff1aSopenharmony_ci    .p.id           = AV_CODEC_ID_WESTWOOD_SND1,
178cabdff1aSopenharmony_ci    .init           = ws_snd_decode_init,
179cabdff1aSopenharmony_ci    FF_CODEC_DECODE_CB(ws_snd_decode_frame),
180cabdff1aSopenharmony_ci    .p.capabilities = AV_CODEC_CAP_DR1 | AV_CODEC_CAP_CHANNEL_CONF,
181cabdff1aSopenharmony_ci    .caps_internal  = FF_CODEC_CAP_INIT_THREADSAFE,
182cabdff1aSopenharmony_ci};
183