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         fn->min_iqs = 2048;
 213         padd->handle = aac_open();
 214 }
 215
 216 static void aacdec_close(struct filter_node *fn)
 217 {
 218         struct private_aacdec_data *padd = fn->private_data;
 219
 220         NeAACDecClose(padd->handle);
 221         free(fn->buf);
 222         fn->buf = NULL;
 223         free(padd);
 224         fn->private_data = NULL;
 225 }
 226
 227 static void aacdec_post_select(__a_unused struct sched *s, struct task *t)
 228 {
 229         struct filter_node *fn = container_of(t, struct filter_node, task);
 230         struct btr_node *btrn = fn->btrn;
 231         struct private_aacdec_data *padd = fn->private_data;
 232         int i, ret;
 233         unsigned char *p, *inbuf, *outbuffer;
 234         char *btr_buf;
 235         size_t len, skip, consumed = 0, loaded, iqs;
 236
 237 next_buffer:
 238         t->error = 0;
 239         ret = prepare_filter_node(fn);
 240         if (ret < 0)
 241                 goto err;
 242         if (ret == 0)
 243                 return;
 244         len = btr_next_buffer(btrn, (char **)&inbuf);
 245         iqs = btr_get_input_queue_size(btrn);
 246         if (!padd->initialized) {
 247                 unsigned long rate = 0;
 248                 unsigned char channels = 0;
 249                 ret = aac_find_esds(inbuf, len, &skip, &padd->decoder_length);
 250                 if (ret < 0) {
 251                         PARA_INFO_LOG("%s\n", para_strerror(-ret));
 252                         ret = NeAACDecInit(padd->handle, inbuf,
 253                                 len, &rate, &channels);
 254                         PARA_INFO_LOG("decoder init: %d\n", ret);
 255                         if (ret < 0) {
 256                                 ret = -E_AACDEC_INIT;
 257                                 goto out;
 258                         }
 259                         consumed = ret;
 260                 } else {
 261                         PARA_INFO_LOG("decoder len: %lu\n",
 262                                 padd->decoder_length);
 263                         consumed += skip;
 264                         p = inbuf + consumed;
 265                         ret = -E_AACDEC_INIT;
 266                         if (NeAACDecInit2(padd->handle, p,
 267                                         padd->decoder_length, &rate,
 268                                         &channels) < 0)
 269                                 goto out;
 270                 }
 271                 padd->samplerate = rate;
 272                 padd->channels = channels;
 273                 PARA_INFO_LOG("rate: %u, channels: %d\n",
 274                         padd->samplerate, padd->channels);
 275                 padd->initialized = 1;
 276         }
 277         if (padd->decoder_length > 0) {
 278                 consumed = 0;
 279                 if (!padd->entry) {
 280                         ret = aac_find_entry_point(inbuf + consumed,
 281                                 len - consumed, &skip);
 282                         if (ret < 0) {
 283                                 ret = len;
 284                                 goto out;
 285                         }
 286                         consumed += skip;
 287                         padd->entry = ret;
 288                         PARA_INFO_LOG("entry: %zu\n", padd->entry);
 289                 }
 290                 ret = len;
 291                 if (padd->consumed_total + len < padd->entry)
 292                         goto out;
 293                 if (padd->consumed_total < padd->entry)
 294                         consumed = padd->entry - padd->consumed_total;
 295         }
 296         for (; consumed < len; consumed++)
 297                 if ((inbuf[consumed] & 0xfe) == 0x20)
 298                         break;
 299         if (consumed >= len)
 300                 goto success;
 301         p = inbuf + consumed;
 302         //PARA_CRIT_LOG("consumed: %zu (%zu + %zu), have: %zu\n", padd->consumed_total + consumed,
 303         //      padd->consumed_total, consumed, len - consumed);
 304         outbuffer = NeAACDecDecode(padd->handle, &padd->frame_info, p,
 305                 len - consumed);
 306         if (padd->frame_info.error) {
 307                 int err = padd->frame_info.error;
 308                 ret = -E_AAC_DECODE;
 309                 if (padd->error_count++ > MAX_ERRORS)
 310                         goto err;
 311                 PARA_ERROR_LOG("frame_error: %d (%s), consumed: %zu + %zd + %lu\n",
 312                         err, NeAACDecGetErrorMessage(padd->frame_info.error),
 313                         padd->consumed_total, consumed,
 314                         padd->frame_info.bytesconsumed);
 315                 PARA_ERROR_LOG("%s\n", NeAACDecGetErrorMessage(
 316                         padd->frame_info.error));
 317                 consumed++; /* catch 21 */
 318                 goto success;
 319         }
 320         padd->error_count = 0;
 321         //PARA_CRIT_LOG("decoder ate %lu\n", padd->frame_info.bytesconsumed);
 322         consumed += padd->frame_info.bytesconsumed;
 323         ret = consumed;
 324         if (!padd->frame_info.samples)
 325                 goto out;
 326         btr_buf = para_malloc(2 * padd->frame_info.samples);
 327         loaded = 0;
 328         for (i = 0; i < padd->frame_info.samples; i++) {
 329                 short sh = ((short *)outbuffer)[i];
 330                 write_int16_host_endian(btr_buf + loaded, sh);
 331                 loaded += 2;
 332         }
 333         btr_add_output(btr_buf, loaded, btrn);
 334 success:
 335         ret = consumed;
 336 out:
 337         if (ret >= 0) {
 338                 padd->consumed_total += ret;
 339                 btr_consume(btrn, ret);
 340                 goto next_buffer;
 341         }
 342 err:
 343         assert(ret < 0);
 344         aacdec_close(fn);
 345         t->error = ret;
 346         btr_del_node(btrn);
 347 }
 348
 349 /**
 350  * the init function of the aacdec filter
 351  *
 352  * \param f pointer to the filter struct to initialize
 353  *
 354  * \sa filter::init
 355  */
 356 void aacdec_filter_init(struct filter *f)
 357 {
 358         f->open = aacdec_open;
 359         f->convert = aacdec;
 360         f->close = aacdec_close;
 361         f->pre_select = aacdec_pre_select;
 362         f->post_select = aacdec_post_select;
 363         f->post_select = aacdec_post_select;
 364         f->execute = aacdec_execute;
 365 }