spu: sync on koff
[pcsx_rearmed.git] / libpcsxcore / decode_xa.c
1 /***************************************************************************
2  *   Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team              *
3  *                                                                         *
4  *   This program is free software; you can redistribute it and/or modify  *
5  *   it under the terms of the GNU General Public License as published by  *
6  *   the Free Software Foundation; either version 2 of the License, or     *
7  *   (at your option) any later version.                                   *
8  *                                                                         *
9  *   This program is distributed in the hope that it will be useful,       *
10  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
11  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
12  *   GNU General Public License for more details.                          *
13  *                                                                         *
14  *   You should have received a copy of the GNU General Public License     *
15  *   along with this program; if not, write to the                         *
16  *   Free Software Foundation, Inc.,                                       *
17  *   51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA.           *
18  ***************************************************************************/
19
20 /* 
21 * XA audio decoding functions (Kazzuya).
22 */
23
24 #include "decode_xa.h"
25
26 #define FIXED
27
28 #define NOT(_X_)                                (!(_X_))
29 #define XACLAMP(_X_,_MI_,_MA_)  {if(_X_<_MI_)_X_=_MI_;if(_X_>_MA_)_X_=_MA_;}
30
31 #define SH      4
32 #define SHC     10
33
34 //============================================
35 //===  ADPCM DECODING ROUTINES
36 //============================================
37
38 #ifndef FIXED
39 static double K0[4] = {
40     0.0,
41     0.9375,
42     1.796875,
43     1.53125
44 };
45
46 static double K1[4] = {
47     0.0,
48     0.0,
49     -0.8125,
50     -0.859375
51 };
52 #else
53 static int K0[4] = {
54         0.0       * (1<<SHC),
55         0.9375    * (1<<SHC),
56         1.796875  * (1<<SHC),
57         1.53125   * (1<<SHC)
58 };
59  
60 static int K1[4] = {
61         0.0       * (1<<SHC),
62         0.0       * (1<<SHC),
63         -0.8125   * (1<<SHC),
64         -0.859375 * (1<<SHC)
65 };
66 #endif
67
68 #define BLKSIZ 28       /* block size (32 - 4 nibbles) */
69
70 //===========================================
71 void ADPCM_InitDecode(ADPCM_Decode_t *decp) {
72         decp->y0 = 0;
73         decp->y1 = 0;
74 }
75
76 //===========================================
77 #ifndef FIXED
78 #define IK0(fid)        ((int)((-K0[fid]) * (1<<SHC)))
79 #define IK1(fid)        ((int)((-K1[fid]) * (1<<SHC)))
80 #else
81 #define IK0(fid)        (-K0[fid])
82 #define IK1(fid)        (-K1[fid])
83 #endif
84
85 static __inline void ADPCM_DecodeBlock16( ADPCM_Decode_t *decp, u8 filter_range, const void *vblockp, short *destp, int inc ) {
86         int i;
87         int range, filterid;
88         s32 fy0, fy1;
89         const u16 *blockp;
90
91         blockp = (const unsigned short *)vblockp;
92         filterid = (filter_range >>  4) & 0x0f;
93         range    = (filter_range >>  0) & 0x0f;
94
95         fy0 = decp->y0;
96         fy1 = decp->y1;
97
98         for (i = BLKSIZ/4; i; --i) {
99                 s32 y;
100                 s32 x0, x1, x2, x3;
101
102                 y = *blockp++;
103                 x3 = (short)( y        & 0xf000) >> range; x3 <<= SH;
104                 x2 = (short)((y <<  4) & 0xf000) >> range; x2 <<= SH;
105                 x1 = (short)((y <<  8) & 0xf000) >> range; x1 <<= SH;
106                 x0 = (short)((y << 12) & 0xf000) >> range; x0 <<= SH;
107
108                 x0 -= (IK0(filterid) * fy0 + (IK1(filterid) * fy1)) >> SHC; fy1 = fy0; fy0 = x0;
109                 x1 -= (IK0(filterid) * fy0 + (IK1(filterid) * fy1)) >> SHC; fy1 = fy0; fy0 = x1;
110                 x2 -= (IK0(filterid) * fy0 + (IK1(filterid) * fy1)) >> SHC; fy1 = fy0; fy0 = x2;
111                 x3 -= (IK0(filterid) * fy0 + (IK1(filterid) * fy1)) >> SHC; fy1 = fy0; fy0 = x3;
112
113                 XACLAMP( x0, (int)(-32768u<<SH), 32767<<SH ); *destp = x0 >> SH; destp += inc;
114                 XACLAMP( x1, (int)(-32768u<<SH), 32767<<SH ); *destp = x1 >> SH; destp += inc;
115                 XACLAMP( x2, (int)(-32768u<<SH), 32767<<SH ); *destp = x2 >> SH; destp += inc;
116                 XACLAMP( x3, (int)(-32768u<<SH), 32767<<SH ); *destp = x3 >> SH; destp += inc;
117         }
118         decp->y0 = fy0;
119         decp->y1 = fy1;
120 }
121
122 static int headtable[4] = {0,2,8,10};
123
124 //===========================================
125 static void xa_decode_data( xa_decode_t *xdp, unsigned char *srcp ) {
126         const u8    *sound_groupsp;
127         const u8    *sound_datap, *sound_datap2;
128         int         i, j, k, nbits;
129         u16                     data[4096], *datap;
130         short           *destp;
131
132         destp = xdp->pcm;
133         nbits = xdp->nbits == 4 ? 4 : 2;
134
135         if (xdp->stereo) { // stereo
136                 if ((xdp->nbits == 8) && (xdp->freq == 37800)) { // level A
137                         for (j=0; j < 18; j++) {
138                                 sound_groupsp = srcp + j * 128;         // sound groups header
139                                 sound_datap = sound_groupsp + 16;       // sound data just after the header
140
141                                 for (i=0; i < nbits; i++) {
142                                 datap = data;
143                                 sound_datap2 = sound_datap + i;
144
145                                         for (k=0; k < 14; k++, sound_datap2 += 8) {
146                                                 *(datap++) = (u16)sound_datap2[0] |
147                                                      (u16)(sound_datap2[4] << 8);
148                                         }
149
150                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+0], data,
151                                                             destp+0, 2 );
152
153                                 datap = data;
154                                 sound_datap2 = sound_datap + i;
155                                 for (k=0; k < 14; k++, sound_datap2 += 8) {
156                                                 *(datap++) = (u16)sound_datap2[0] |
157                                                      (u16)(sound_datap2[4] << 8);
158                                         }
159                                         ADPCM_DecodeBlock16( &xdp->right,  sound_groupsp[headtable[i]+1], data,
160                                                     destp+1, 2 );
161
162                                 destp += 28*2;
163                                 }
164                 }
165                 } else { // level B/C
166                         for (j=0; j < 18; j++) {
167                                 sound_groupsp = srcp + j * 128;         // sound groups header
168                                 sound_datap = sound_groupsp + 16;       // sound data just after the header
169
170                                 for (i=0; i < nbits; i++) {
171                                 datap = data;
172                                 sound_datap2 = sound_datap + i;
173
174                                 for (k=0; k < 7; k++, sound_datap2 += 16) {
175                                                 *(datap++) = (u16)(sound_datap2[ 0] & 0x0f) |
176                                                     ((u16)(sound_datap2[ 4] & 0x0f) <<  4) |
177                                                     ((u16)(sound_datap2[ 8] & 0x0f) <<  8) |
178                                                     ((u16)(sound_datap2[12] & 0x0f) << 12);
179                                         }
180                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+0], data,
181                                                     destp+0, 2 );
182
183                                 datap = data;
184                                 sound_datap2 = sound_datap + i;
185                                 for (k=0; k < 7; k++, sound_datap2 += 16) {
186                                                 *(datap++) = (u16)(sound_datap2[ 0] >> 4) |
187                                                 ((u16)(sound_datap2[ 4] >> 4) <<  4) |
188                                                     ((u16)(sound_datap2[ 8] >> 4) <<  8) |
189                                                     ((u16)(sound_datap2[12] >> 4) << 12);
190                                         }
191                                         ADPCM_DecodeBlock16( &xdp->right,  sound_groupsp[headtable[i]+1], data,
192                                                     destp+1, 2 );
193
194                                 destp += 28*2;
195                                 }
196                 }
197                 }
198         } else { // mono
199                 if ((xdp->nbits == 8) && (xdp->freq == 37800)) { // level A
200                         for (j=0; j < 18; j++) {
201                         sound_groupsp = srcp + j * 128;         // sound groups header
202                         sound_datap = sound_groupsp + 16;       // sound data just after the header
203
204                         for (i=0; i < nbits; i++) {
205                                 datap = data;
206                                 sound_datap2 = sound_datap + i;
207                                 for (k=0; k < 14; k++, sound_datap2 += 8) {
208                                                 *(datap++) = (u16)sound_datap2[0] |
209                                                      (u16)(sound_datap2[4] << 8);
210                                         }
211                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+0], data,
212                                                     destp, 1 );
213
214                                 destp += 28;
215
216                                 datap = data;
217                                 sound_datap2 = sound_datap + i;
218                                 for (k=0; k < 14; k++, sound_datap2 += 8) {
219                                                 *(datap++) = (u16)sound_datap2[0] |
220                                                      (u16)(sound_datap2[4] << 8);
221                                         }
222                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+1], data,
223                                                     destp, 1 );
224
225                                         destp += 28;
226                                 }
227                 }
228                 } else { // level B/C
229                         for (j=0; j < 18; j++) {
230                         sound_groupsp = srcp + j * 128;         // sound groups header
231                         sound_datap = sound_groupsp + 16;       // sound data just after the header
232
233                         for (i=0; i < nbits; i++) {
234                                 datap = data;
235                                 sound_datap2 = sound_datap + i;
236                                 for (k=0; k < 7; k++, sound_datap2 += 16) {
237                                                 *(datap++) = (u16)(sound_datap2[ 0] & 0x0f) |
238                                                     ((u16)(sound_datap2[ 4] & 0x0f) <<  4) |
239                                                     ((u16)(sound_datap2[ 8] & 0x0f) <<  8) |
240                                                     ((u16)(sound_datap2[12] & 0x0f) << 12);
241                                         }
242                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+0], data,
243                                                     destp, 1 );
244
245                                 destp += 28;
246
247                                 datap = data;
248                                 sound_datap2 = sound_datap + i;
249                                 for (k=0; k < 7; k++, sound_datap2 += 16) {
250                                         *(datap++) = (u16)(sound_datap2[ 0] >> 4) |
251                                             ((u16)(sound_datap2[ 4] >> 4) <<  4) |
252                                                         ((u16)(sound_datap2[ 8] >> 4) <<  8) |
253                                                         ((u16)(sound_datap2[12] >> 4) << 12);
254                                 }
255                                 ADPCM_DecodeBlock16( &xdp->left,  sound_groupsp[headtable[i]+1], data,
256                                                     destp, 1 );
257
258                                         destp += 28;
259                                 }
260                 }
261                 }
262         }
263 }
264
265 //============================================
266 //===  XA SPECIFIC ROUTINES
267 //============================================
268 typedef struct {
269 u8  filenum;
270 u8  channum;
271 u8  submode;
272 u8  coding;
273
274 u8  filenum2;
275 u8  channum2;
276 u8  submode2;
277 u8  coding2;
278 } xa_subheader_t;
279
280 #define SUB_SUB_EOF     (1<<7)  // end of file
281 #define SUB_SUB_RT      (1<<6)  // real-time sector
282 #define SUB_SUB_FORM    (1<<5)  // 0 form1  1 form2
283 #define SUB_SUB_TRIGGER (1<<4)  // used for interrupt
284 #define SUB_SUB_DATA    (1<<3)  // contains data
285 #define SUB_SUB_AUDIO   (1<<2)  // contains audio
286 #define SUB_SUB_VIDEO   (1<<1)  // contains video
287 #define SUB_SUB_EOR     (1<<0)  // end of record
288
289 #define AUDIO_CODING_GET_STEREO(_X_)    ( (_X_) & 3)
290 #define AUDIO_CODING_GET_FREQ(_X_)      (((_X_) >> 2) & 3)
291 #define AUDIO_CODING_GET_BPS(_X_)       (((_X_) >> 4) & 3)
292 #define AUDIO_CODING_GET_EMPHASIS(_X_)  (((_X_) >> 6) & 1)
293
294 #define SUB_UNKNOWN 0
295 #define SUB_VIDEO   1
296 #define SUB_AUDIO   2
297
298 //============================================
299 static int parse_xa_audio_sector( xa_decode_t *xdp, 
300                                                                   xa_subheader_t *subheadp,
301                                                                   unsigned char *sectorp,
302                                                                   int is_first_sector ) {
303     if ( is_first_sector ) {
304                 switch ( AUDIO_CODING_GET_FREQ(subheadp->coding) ) {
305                         case 0: xdp->freq = 37800;   break;
306                         case 1: xdp->freq = 18900;   break;
307                         default: xdp->freq = 0;      break;
308                 }
309                 switch ( AUDIO_CODING_GET_BPS(subheadp->coding) ) {
310                         case 0: xdp->nbits = 4; break;
311                         case 1: xdp->nbits = 8; break;
312                         default: xdp->nbits = 0; break;
313                 }
314                 switch ( AUDIO_CODING_GET_STEREO(subheadp->coding) ) {
315                         case 0: xdp->stereo = 0; break;
316                         case 1: xdp->stereo = 1; break;
317                         default: xdp->stereo = 0; break;
318                 }
319
320                 if ( xdp->freq == 0 )
321                         return -1;
322
323                 ADPCM_InitDecode( &xdp->left );
324                 ADPCM_InitDecode( &xdp->right );
325
326                 xdp->nsamples = 18 * 28 * 8;
327                 if (xdp->stereo == 1) xdp->nsamples /= 2;
328     }
329         xa_decode_data( xdp, sectorp );
330
331         return 0;
332 }
333
334 //================================================================
335 //=== THIS IS WHAT YOU HAVE TO CALL
336 //=== xdp              - structure were all important data are returned
337 //=== sectorp          - data in input
338 //=== pcmp             - data in output
339 //=== is_first_sector  - 1 if it's the 1st sector of the stream
340 //===                  - 0 for any other successive sector
341 //=== return -1 if error
342 //================================================================
343 s32 xa_decode_sector( xa_decode_t *xdp,
344                                            unsigned char *sectorp, int is_first_sector ) {
345         if (parse_xa_audio_sector(xdp, (xa_subheader_t *)sectorp, sectorp + sizeof(xa_subheader_t), is_first_sector))
346                 return -1;
347
348         return 0;
349 }
350
351 /* EXAMPLE:
352 "nsamples" is the number of 16 bit samples
353 every sample is 2 bytes in mono and 4 bytes in stereo
354
355 xa_decode_t     xa;
356
357         sectorp = read_first_sector();
358         xa_decode_sector( &xa, sectorp, 1 );
359         play_wave( xa.pcm, xa.freq, xa.nsamples );
360
361         while ( --n_sectors )
362         {
363                 sectorp = read_next_sector();
364                 xa_decode_sector( &xa, sectorp, 0 );
365                 play_wave( xa.pcm, xa.freq, xa.nsamples );
366         }
367 */