aacdec_filter.c

   1 /*
   2  * Copyright (C) 2006-2009 Andre Noll <maan@systemlinux.org>
   3  *
   4  * Licensed under the GPL v2. For licencing details see COPYING.
   5  */
   6 /*
   7  * based in parts on libfaad, Copyright (C) 2003-2005 M. Bakker,
   8  * Ahead Software AG
   9  */
  10
  11 /** \file aacdec_filter.c paraslash's aac (m4a) decoder. */
  12
  13 #include <regex.h>
  14 #include <stdbool.h>
  15
  16 #include "para.h"
  17 #include "list.h"
  18 #include "sched.h"
  19 #include "ggo.h"
  20 #include "buffer_tree.h"
  21 #include "filter.h"
  22 #include "error.h"
  23 #include "string.h"
  24 #include "aac.h"
  25
  26 /** the output buffer size */
  27 #define AAC_OUTBUF_SIZE (32 * 1024)
  28
  29 /** give up decoding after that many errors */
  30 #define MAX_ERRORS 20
  31
  32 /**
  33  * data specific to the aacdec filter
  34  *
  35  * \sa filter, filter_node
  36  */
  37 struct private_aacdec_data {
  38         /** the return value of aac_open */
  39         NeAACDecHandle handle;
  40         /** info about the currently decoded frame */
  41         NeAACDecFrameInfo frame_info;
  42         /** whether this instance of the aac decoder is already initialized */
  43         int initialized;
  44         /**
  45          * return value of aac_find_esds(). Used to call the right aacdec
  46          * init function
  47          */
  48         unsigned long decoder_length;
  49         /** number of times the decoder returned an error */
  50         unsigned error_count;
  51         /** number of bytes already consumed from the imput stream */
  52         size_t consumed_total;
  53         /** return value of aac_find_entry_point */
  54         size_t entry;
  55         /** The number of channels of the current stream. */
  56         unsigned int channels;
  57         /** Current sample rate in Hz. */
  58         unsigned int samplerate;
  59 };
  60
  61 #define AACDEC_MAX_PENDING (640 * 1024)
  62
  63 static void aacdec_pre_select(struct sched *s, struct task *t)
  64 {
  65         struct filter_node *fn = container_of(t, struct filter_node, task);
  66         size_t iqs = btr_get_input_queue_size(fn->btrn);
  67
  68         t->error = 0;
  69         if (iqs == 0)
  70                 return;
  71         if (btr_bytes_pending(fn->btrn) > AACDEC_MAX_PENDING)
  72                 return; /* FIXME, should use reasonable bound on timeout */
  73         s->timeout.tv_sec = 0;
  74         s->timeout.tv_usec = 1;
  75 }
  76
  77 static ssize_t aacdec(char *input_buffer, size_t len, struct filter_node *fn)
  78 {
  79         struct private_aacdec_data *padd = fn->private_data;
  80         struct filter_chain *fc = fn->fc;
  81         int i, ret;
  82         unsigned char *p, *outbuffer;
  83         unsigned char *inbuf = (unsigned char*)input_buffer;
  84         size_t skip, consumed = 0;
  85
  86         if (fn->loaded > fn->bufsize * 3 / 5)
  87                 return 0;
  88         ret = *fc->input_error;
  89         if (ret < 0)
  90                 return ret;
  91         if (len < 2048)
  92                 return 0;
  93
  94         if (!padd->initialized) {
  95                 unsigned long rate = 0;
  96                 unsigned char channels = 0;
  97                 ret = aac_find_esds(inbuf, len, &skip, &padd->decoder_length);
  98                 if (ret < 0) {
  99                         PARA_INFO_LOG("%s\n", para_strerror(-ret));
 100                         ret = NeAACDecInit(padd->handle, inbuf,
 101                                 len, &rate, &channels);
 102                         PARA_INFO_LOG("decoder init: %d\n", ret);
 103                         if (ret < 0) {
 104                                 ret = -E_AACDEC_INIT;
 105                                 goto out;
 106                         }
 107                         consumed = ret;
 108                 } else {
 109                         PARA_INFO_LOG("decoder len: %lu\n",
 110                                 padd->decoder_length);
 111                         consumed += skip;
 112                         p = inbuf + consumed;
 113                         ret = -E_AACDEC_INIT;
 114                         if (NeAACDecInit2(padd->handle, p,
 115                                         padd->decoder_length, &rate,
 116                                         &channels) < 0)
 117                                 goto out;
 118                 }
 119                 fc->samplerate = rate;
 120                 fc->channels = channels;
 121                 PARA_INFO_LOG("rate: %u, channels: %d\n",
 122                         fc->samplerate, fc->channels);
 123                 padd->initialized = 1;
 124         }
 125         if (padd->decoder_length > 0) {
 126                 consumed = 0;
 127                 if (!padd->entry) {
 128                         ret = aac_find_entry_point(inbuf + consumed,
 129                                 len - consumed, &skip);
 130                         if (ret < 0) {
 131                                 ret = len;
 132                                 goto out;
 133                         }
 134                         consumed += skip;
 135                         padd->entry = ret;
 136                         PARA_INFO_LOG("entry: %zu\n", padd->entry);
 137                 }
 138                 ret = len;
 139                 if (padd->consumed_total + len < padd->entry)
 140                         goto out;
 141                 if (padd->consumed_total < padd->entry)
 142                         consumed = padd->entry - padd->consumed_total;
 143         }
 144         for (; consumed < len; consumed++)
 145                 if ((inbuf[consumed] & 0xfe) == 0x20)
 146                         break;
 147         if (consumed >= len)
 148                 goto success;
 149         p = inbuf + consumed;
 150         outbuffer = NeAACDecDecode(padd->handle, &padd->frame_info, p,
 151                 len - consumed);
 152         if (padd->frame_info.error) {
 153                 ret = -E_AAC_DECODE;
 154                 if (padd->error_count++ > MAX_ERRORS)
 155                         goto out;
 156                 PARA_ERROR_LOG("frame_error: %d, consumed: %zu + %zd + %lu\n",
 157                         padd->frame_info.error, padd->consumed_total,
 158                         consumed, padd->frame_info.bytesconsumed);
 159                 PARA_ERROR_LOG("%s\n", NeAACDecGetErrorMessage(
 160                         padd->frame_info.error));
 161                 consumed++; /* catch 21 */
 162                 goto success;
 163         }
 164         padd->error_count = 0;
 165         consumed += padd->frame_info.bytesconsumed;
 166         ret = consumed;
 167         if (!padd->frame_info.samples)
 168                 goto out;
 169         ret = -E_AAC_OVERRUN;
 170         if (padd->frame_info.samples * 2 + fn->loaded > fn->bufsize)
 171                 goto out;
 172         for (i = 0; i < padd->frame_info.samples; i++) {
 173                 short *s = (short *)outbuffer;
 174                 write_int16_host_endian(fn->buf + fn->loaded, s[i]);
 175                 fn->loaded += 2;
 176         }
 177 success:
 178         ret = consumed;
 179 out:
 180         if (ret > 0)
 181                 padd->consumed_total += ret;
 182         return ret;
 183 }
 184
 185 static int aacdec_execute(struct btr_node *btrn, const char *cmd, char **result)
 186 {
 187         struct filter_node *fn = btr_context(btrn);
 188         struct private_aacdec_data *padd = fn->private_data;
 189
 190         if (!strcmp(cmd, "samplerate")) {
 191                 if (padd->samplerate == 0)
 192                         return -ERRNO_TO_PARA_ERROR(ENAVAIL);
 193                 *result = make_message("%u", padd->samplerate);
 194                 return 1;
 195         }
 196         if (!strcmp(cmd, "channels")) {
 197                 if (padd->channels == 0)
 198                         return -ERRNO_TO_PARA_ERROR(ENAVAIL);
 199                 *result = make_message("%u", padd->channels);
 200                 return 1;
 201         }
 202         return -ERRNO_TO_PARA_ERROR(ENOTSUP);
 203 }
 204
 205 static void aacdec_open(struct filter_node *fn)
 206 {
 207         struct private_aacdec_data *padd = para_calloc(sizeof(*padd));
 208
 209         fn->private_data = padd;
 210         fn->bufsize = AAC_OUTBUF_SIZE;
 211         fn->buf = para_calloc(fn->bufsize);
 212         padd->handle = aac_open();
 213 }
 214
 215 static void aacdec_close(struct filter_node *fn)
 216 {
 217         struct private_aacdec_data *padd = fn->private_data;
 218
 219         NeAACDecClose(padd->handle);
 220         free(fn->buf);
 221         fn->buf = NULL;
 222         free(padd);
 223         fn->private_data = NULL;
 224 }
 225
 226 static void aacdec_post_select(__a_unused struct sched *s, struct task *t)
 227 {
 228         struct filter_node *fn = container_of(t, struct filter_node, task);
 229         struct btr_node *btrn = fn->btrn;
 230         struct private_aacdec_data *padd = fn->private_data;
 231         int i, ret;
 232         unsigned char *p, *inbuf, *outbuffer;
 233         char *btr_buf;
 234         size_t len, skip, consumed = 0, loaded, iqs;
 235
 236 next_buffer:
 237         t->error = 0;
 238         iqs = btr_get_input_queue_size(btrn);
 239         if (iqs < 2048) {
 240                 if (!btr_no_parent(btrn)) /* wait for more data */
 241                         return;
 242         }
 243         if (btr_bytes_pending(btrn) > AACDEC_MAX_PENDING)
 244                 return;
 245         /* avoid "buffer too small" errors from the decoder */
 246         for (;;) {
 247                 len = btr_next_buffer(btrn, (char **)&inbuf);
 248                 if (len >= 2048)
 249                         break;
 250                 if (btr_merge(btrn) < 2) /* only one buffer left */
 251                         break;
 252         }
 253         //PARA_CRIT_LOG("next buffer: %zu\n", len);
 254         if (len == 0) {
 255                 if (btr_no_parent(btrn)) {
 256                         ret = -E_AACDEC_EOF;
 257                         goto err;
 258                 }
 259                 return;
 260         }
 261         if (!padd->initialized) {
 262                 unsigned long rate = 0;
 263                 unsigned char channels = 0;
 264                 ret = aac_find_esds(inbuf, len, &skip, &padd->decoder_length);
 265                 if (ret < 0) {
 266                         PARA_INFO_LOG("%s\n", para_strerror(-ret));
 267                         ret = NeAACDecInit(padd->handle, inbuf,
 268                                 len, &rate, &channels);
 269                         PARA_INFO_LOG("decoder init: %d\n", ret);
 270                         if (ret < 0) {
 271                                 ret = -E_AACDEC_INIT;
 272                                 goto out;
 273                         }
 274                         consumed = ret;
 275                 } else {
 276                         PARA_INFO_LOG("decoder len: %lu\n",
 277                                 padd->decoder_length);
 278                         consumed += skip;
 279                         p = inbuf + consumed;
 280                         ret = -E_AACDEC_INIT;
 281                         if (NeAACDecInit2(padd->handle, p,
 282                                         padd->decoder_length, &rate,
 283                                         &channels) < 0)
 284                                 goto out;
 285                 }
 286                 padd->samplerate = rate;
 287                 padd->channels = channels;
 288                 PARA_INFO_LOG("rate: %u, channels: %d\n",
 289                         padd->samplerate, padd->channels);
 290                 padd->initialized = 1;
 291         }
 292         if (padd->decoder_length > 0) {
 293                 consumed = 0;
 294                 if (!padd->entry) {
 295                         ret = aac_find_entry_point(inbuf + consumed,
 296                                 len - consumed, &skip);
 297                         if (ret < 0) {
 298                                 ret = len;
 299                                 goto out;
 300                         }
 301                         consumed += skip;
 302                         padd->entry = ret;
 303                         PARA_INFO_LOG("entry: %zu\n", padd->entry);
 304                 }
 305                 ret = len;
 306                 if (padd->consumed_total + len < padd->entry)
 307                         goto out;
 308                 if (padd->consumed_total < padd->entry)
 309                         consumed = padd->entry - padd->consumed_total;
 310         }
 311         for (; consumed < len; consumed++)
 312                 if ((inbuf[consumed] & 0xfe) == 0x20)
 313                         break;
 314         if (consumed >= len)
 315                 goto success;
 316         p = inbuf + consumed;
 317         //PARA_CRIT_LOG("consumed: %zu (%zu + %zu), have: %zu\n", padd->consumed_total + consumed,
 318         //      padd->consumed_total, consumed, len - consumed);
 319         outbuffer = NeAACDecDecode(padd->handle, &padd->frame_info, p,
 320                 len - consumed);
 321         if (padd->frame_info.error) {
 322                 int err = padd->frame_info.error;
 323                 ret = -E_AAC_DECODE;
 324                 if (padd->error_count++ > MAX_ERRORS)
 325                         goto err;
 326                 PARA_ERROR_LOG("frame_error: %d (%s), consumed: %zu + %zd + %lu\n",
 327                         err, NeAACDecGetErrorMessage(padd->frame_info.error),
 328                         padd->consumed_total, consumed,
 329                         padd->frame_info.bytesconsumed);
 330                 PARA_ERROR_LOG("%s\n", NeAACDecGetErrorMessage(
 331                         padd->frame_info.error));
 332                 consumed++; /* catch 21 */
 333                 goto success;
 334         }
 335         padd->error_count = 0;
 336         //PARA_CRIT_LOG("decoder ate %lu\n", padd->frame_info.bytesconsumed);
 337         consumed += padd->frame_info.bytesconsumed;
 338         ret = consumed;
 339         if (!padd->frame_info.samples)
 340                 goto out;
 341         btr_buf = para_malloc(2 * padd->frame_info.samples);
 342         loaded = 0;
 343         for (i = 0; i < padd->frame_info.samples; i++) {
 344                 short sh = ((short *)outbuffer)[i];
 345                 write_int16_host_endian(btr_buf + loaded, sh);
 346                 loaded += 2;
 347         }
 348         btr_add_output(btr_buf, loaded, btrn);
 349 success:
 350         ret = consumed;
 351 out:
 352         if (ret >= 0) {
 353                 padd->consumed_total += ret;
 354                 btr_consume(btrn, ret);
 355                 goto next_buffer;
 356         }
 357 err:
 358         assert(ret < 0);
 359         aacdec_close(fn);
 360         t->error = ret;
 361         btr_del_node(btrn);
 362 }
 363
 364 /**
 365  * the init function of the aacdec filter
 366  *
 367  * \param f pointer to the filter struct to initialize
 368  *
 369  * \sa filter::init
 370  */
 371 void aacdec_filter_init(struct filter *f)
 372 {
 373         f->open = aacdec_open;
 374         f->convert = aacdec;
 375         f->close = aacdec_close;
 376         f->pre_select = aacdec_pre_select;
 377         f->post_select = aacdec_post_select;
 378         f->post_select = aacdec_post_select;
 379         f->execute = aacdec_execute;
 380 }