1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
8 * Copyright (C) 2009 Mohamed Tarek
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version 2
13 * of the License, or (at your option) any later version.
15 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
16 * KIND, either express or implied.
18 ****************************************************************************/
25 #include "libcook/cook.h"
31 COOKContext q IBSS_ATTR
;
33 static void init_rm(RMContext
*rmctx
)
35 memcpy(rmctx
, (void*)(( (intptr_t)ci
->id3
->id3v2buf
+ 3 ) &~ 3), sizeof(RMContext
));
38 /* this is the codec entry point */
39 enum codec_status
codec_main(void)
41 static size_t buff_size
;
42 int datasize
, res
, consumed
, i
, time_offset
;
44 int16_t outbuf
[2048] __attribute__((aligned(32)));
46 uint32_t packet_count
;
47 int scrambling_unit_size
, num_units
;
48 size_t resume_offset
= ci
->id3
->offset
;
52 DEBUGF("codec init failed\n");
55 while (!*ci
->taginfo_ready
&& !ci
->stop_codec
)
58 codec_set_replaygain(ci
->id3
);
59 ci
->memset(&rmctx
,0,sizeof(RMContext
));
60 ci
->memset(&pkt
,0,sizeof(RMPacket
));
61 ci
->memset(&q
,0,sizeof(COOKContext
));
65 ci
->configure(DSP_SET_FREQUENCY
, ci
->id3
->frequency
);
66 ci
->configure(DSP_SET_SAMPLE_DEPTH
, 16);
67 ci
->configure(DSP_SET_STEREO_MODE
, rmctx
.nb_channels
== 1 ?
68 STEREO_MONO
: STEREO_INTERLEAVED
);
70 packet_count
= rmctx
.nb_packets
;
71 rmctx
.audio_framesize
= rmctx
.block_align
;
72 rmctx
.block_align
= rmctx
.sub_packet_size
;
73 fs
= rmctx
.audio_framesize
;
74 sps
= rmctx
.block_align
;
75 h
= rmctx
.sub_packet_h
;
76 scrambling_unit_size
= h
*fs
;
78 res
=cook_decode_init(&rmctx
, &q
);
80 DEBUGF("failed to initialize cook decoder\n");
84 /* check for a mid-track resume and force a seek time accordingly */
85 if(resume_offset
> rmctx
.data_offset
+ DATA_HEADER_SIZE
) {
86 resume_offset
-= rmctx
.data_offset
+ DATA_HEADER_SIZE
;
87 num_units
= (int)resume_offset
/ scrambling_unit_size
;
88 /* put number of subpackets to skip in resume_offset */
89 resume_offset
/= (sps
+ PACKET_HEADER_SIZE
);
90 ci
->seek_time
= (int)resume_offset
* ((sps
* 8 * 1000)/rmctx
.bit_rate
);
94 ci
->advance_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
);
96 /* The main decoder loop */
100 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
101 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
103 DEBUGF("rm_get_packet failed\n");
107 for(i
= 0; i
< rmctx
.audio_pkt_cnt
*(fs
/sps
) ; i
++)
110 if (ci
->stop_codec
|| ci
->new_track
)
114 ci
->set_elapsed(ci
->seek_time
);
116 /* Do not allow seeking beyond the file's length */
117 if ((unsigned) ci
->seek_time
> ci
->id3
->length
) {
122 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
);
123 packet_count
= rmctx
.nb_packets
;
124 rmctx
.audio_pkt_cnt
= 0;
125 rmctx
.frame_number
= 0;
127 /* Seek to the start of the track */
128 if (ci
->seek_time
== 1) {
133 num_units
= ((ci
->seek_time
)/(sps
*1000*8/rmctx
.bit_rate
))/(h
*(fs
/sps
));
134 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
+ consumed
* num_units
);
135 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
136 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
138 DEBUGF("rm_get_packet failed\n");
141 packet_count
= rmctx
.nb_packets
- rmctx
.audio_pkt_cnt
* num_units
;
142 rmctx
.frame_number
= ((ci
->seek_time
)/(sps
*1000*8/rmctx
.bit_rate
));
143 while(rmctx
.audiotimestamp
> (unsigned) ci
->seek_time
) {
144 rmctx
.audio_pkt_cnt
= 0;
145 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
+ consumed
* (num_units
-1));
146 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
147 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
148 packet_count
+= rmctx
.audio_pkt_cnt
;
151 time_offset
= ci
->seek_time
- rmctx
.audiotimestamp
;
152 i
= (time_offset
/((sps
* 8 * 1000)/rmctx
.bit_rate
));
153 ci
->set_elapsed(rmctx
.audiotimestamp
+(1000*8*sps
/rmctx
.bit_rate
)*i
);
156 res
= cook_decode_frame(&rmctx
,&q
, outbuf
, &datasize
, pkt
.frames
[i
], rmctx
.block_align
);
157 rmctx
.frame_number
++;
159 /* skip the first two frames; no valid audio */
160 if(rmctx
.frame_number
< 3) continue;
162 if(res
!= rmctx
.block_align
) {
163 DEBUGF("codec error\n");
167 ci
->pcmbuf_insert(outbuf
, NULL
, q
.samples_per_frame
/ rmctx
.nb_channels
);
168 ci
->set_elapsed(rmctx
.audiotimestamp
+(1000*8*sps
/rmctx
.bit_rate
)*i
);
170 packet_count
-= rmctx
.audio_pkt_cnt
;
171 rmctx
.audio_pkt_cnt
= 0;
172 ci
->advance_buffer(consumed
);
176 if (ci
->request_next_track())