1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
10 * Copyright (C) 2009 Mohamed Tarek
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
27 #include "libatrac/atrac3.h"
31 static RMContext rmctx
;
33 static ATRAC3Context q IBSS_ATTR
;
35 static void init_rm(RMContext
*rmctx
)
37 /* initialize the RMContext */
38 memcpy(rmctx
, (void*)(( (intptr_t)ci
->id3
->id3v2buf
+ 3 ) &~ 3), sizeof(RMContext
));
40 /* and atrac3 expects extadata in id3v2buf, so we shall give it that */
41 memcpy(ci
->id3
->id3v2buf
, (char*)rmctx
->codec_extradata
, rmctx
->extradata_size
*sizeof(char));
44 /* this is the codec entry point */
45 enum codec_status
codec_main(enum codec_entry_call_reason reason
)
52 /* this is called for each file to process */
53 enum codec_status
codec_run(void)
55 static size_t buff_size
;
56 int datasize
, res
, consumed
, i
, time_offset
;
59 uint32_t packet_count
;
60 int scrambling_unit_size
, num_units
, elapsed
= 0;
64 enum codec_command_action action
= CODEC_ACTION_NULL
;
67 DEBUGF("codec init failed\n");
71 resume_offset
= ci
->id3
->offset
;
73 codec_set_replaygain(ci
->id3
);
74 ci
->memset(&rmctx
,0,sizeof(RMContext
));
75 ci
->memset(&pkt
,0,sizeof(RMPacket
));
76 ci
->memset(&q
,0,sizeof(ATRAC3Context
));
81 ci
->configure(DSP_SET_FREQUENCY
, ci
->id3
->frequency
);
82 ci
->configure(DSP_SET_SAMPLE_DEPTH
, 17); /* Remark: atrac3 uses s15.0 by default, s15.2 was hacked. */
83 ci
->configure(DSP_SET_STEREO_MODE
, rmctx
.nb_channels
== 1 ?
84 STEREO_MONO
: STEREO_NONINTERLEAVED
);
86 packet_count
= rmctx
.nb_packets
;
87 rmctx
.audio_framesize
= rmctx
.block_align
;
88 rmctx
.block_align
= rmctx
.sub_packet_size
;
89 fs
= rmctx
.audio_framesize
;
90 sps
= rmctx
.block_align
;
91 h
= rmctx
.sub_packet_h
;
92 scrambling_unit_size
= h
*fs
;
94 res
= atrac3_decode_init(&q
, ci
->id3
);
96 DEBUGF("failed to initialize RM atrac decoder\n");
100 /* check for a mid-track resume and force a seek time accordingly */
101 if(resume_offset
> rmctx
.data_offset
+ DATA_HEADER_SIZE
) {
102 resume_offset
-= rmctx
.data_offset
+ DATA_HEADER_SIZE
;
103 num_units
= (int)resume_offset
/ scrambling_unit_size
;
104 /* put number of subpackets to skip in resume_offset */
105 resume_offset
/= (sps
+ PACKET_HEADER_SIZE
);
106 param
= (int)resume_offset
* ((sps
* 8 * 1000)/rmctx
.bit_rate
);
107 action
= CODEC_ACTION_SEEK_TIME
;
113 ci
->advance_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
);
115 /* The main decoder loop */
117 while((unsigned)elapsed
< rmctx
.duration
)
119 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
120 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
121 if(consumed
< 0 && playback_on
!= 0) {
122 if(playback_on
== -1) {
123 /* Error only if packet-parsing failed and playback hadn't started */
124 DEBUGF("rm_get_packet failed\n");
131 for(i
= 0; i
< rmctx
.audio_pkt_cnt
*(fs
/sps
) ; i
++)
133 if (action
== CODEC_ACTION_NULL
)
134 action
= ci
->get_command(¶m
);
136 if (action
== CODEC_ACTION_HALT
)
139 if (action
== CODEC_ACTION_SEEK_TIME
) {
140 /* Do not allow seeking beyond the file's length */
141 if ((unsigned) param
> ci
->id3
->length
) {
142 ci
->set_elapsed(ci
->id3
->length
);
147 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
);
148 packet_count
= rmctx
.nb_packets
;
149 rmctx
.audio_pkt_cnt
= 0;
150 rmctx
.frame_number
= 0;
152 /* Seek to the start of the track */
156 action
= CODEC_ACTION_NULL
;
159 num_units
= (param
/(sps
*1000*8/rmctx
.bit_rate
))/(h
*(fs
/sps
));
160 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
+ consumed
* num_units
);
161 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
162 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
163 if(consumed
< 0 && playback_on
!= 0) {
164 if(playback_on
== -1) {
165 /* Error only if packet-parsing failed and playback hadn't started */
166 DEBUGF("rm_get_packet failed\n");
173 packet_count
= rmctx
.nb_packets
- rmctx
.audio_pkt_cnt
* num_units
;
174 rmctx
.frame_number
= (param
/(sps
*1000*8/rmctx
.bit_rate
));
175 while(rmctx
.audiotimestamp
> (unsigned) param
) {
176 rmctx
.audio_pkt_cnt
= 0;
177 ci
->seek_buffer(rmctx
.data_offset
+ DATA_HEADER_SIZE
+ consumed
* (num_units
-1));
178 bit_buffer
= (uint8_t *) ci
->request_buffer(&buff_size
, scrambling_unit_size
);
179 consumed
= rm_get_packet(&bit_buffer
, &rmctx
, &pkt
);
180 packet_count
+= rmctx
.audio_pkt_cnt
;
183 time_offset
= param
- rmctx
.audiotimestamp
;
184 i
= (time_offset
/((sps
* 8 * 1000)/rmctx
.bit_rate
));
185 elapsed
= rmctx
.audiotimestamp
+(1000*8*sps
/rmctx
.bit_rate
)*i
;
186 ci
->set_elapsed(elapsed
);
190 action
= CODEC_ACTION_NULL
;
193 res
= atrac3_decode_frame(rmctx
.block_align
, &q
, &datasize
, pkt
.frames
[i
], rmctx
.block_align
);
194 else /* indicates that there are no remaining frames */
197 if(res
!= rmctx
.block_align
) {
198 DEBUGF("codec error\n");
203 ci
->pcmbuf_insert(q
.outSamples
, q
.outSamples
+ 1024, q
.samples_per_frame
/ rmctx
.nb_channels
);
205 elapsed
= rmctx
.audiotimestamp
+(1000*8*sps
/rmctx
.bit_rate
)*i
;
206 ci
->set_elapsed(elapsed
);
207 rmctx
.frame_number
++;
209 packet_count
-= rmctx
.audio_pkt_cnt
;
210 rmctx
.audio_pkt_cnt
= 0;
211 ci
->advance_buffer(consumed
);