[btr] Split btr_del_node() into two functions.
[paraslash.git] / aacdec_filter.c
index ae3a90e6c908391869ed551d5443f8e570089306..602df63ef7bd91520f426cbe35ea85cc7ae91fe0 100644 (file)
@@ -52,6 +52,10 @@ struct private_aacdec_data {
        size_t consumed_total;
        /** return value of aac_find_entry_point */
        size_t entry;
+       /** The number of channels of the current stream. */
+       unsigned int channels;
+       /** Current sample rate in Hz. */
+       unsigned int samplerate;
 };
 
 static ssize_t aacdec(char *input_buffer, size_t len, struct filter_node *fn)
@@ -162,6 +166,26 @@ out:
        return ret;
 }
 
+static int aacdec_execute(struct btr_node *btrn, const char *cmd, char **result)
+{
+       struct filter_node *fn = btr_context(btrn);
+       struct private_aacdec_data *padd = fn->private_data;
+
+       if (!strcmp(cmd, "samplerate")) {
+               if (padd->samplerate == 0)
+                       return -ERRNO_TO_PARA_ERROR(ENAVAIL);
+               *result = make_message("%u", padd->samplerate);
+               return 1;
+       }
+       if (!strcmp(cmd, "channels")) {
+               if (padd->channels == 0)
+                       return -ERRNO_TO_PARA_ERROR(ENAVAIL);
+               *result = make_message("%u", padd->channels);
+               return 1;
+       }
+       return -ERRNO_TO_PARA_ERROR(ENOTSUP);
+}
+
 static void aacdec_open(struct filter_node *fn)
 {
        struct private_aacdec_data *padd = para_calloc(sizeof(*padd));
@@ -169,6 +193,7 @@ static void aacdec_open(struct filter_node *fn)
        fn->private_data = padd;
        fn->bufsize = AAC_OUTBUF_SIZE;
        fn->buf = para_calloc(fn->bufsize);
+       fn->min_iqs = 2048;
        padd->handle = aac_open();
 }
 
@@ -183,6 +208,128 @@ static void aacdec_close(struct filter_node *fn)
        fn->private_data = NULL;
 }
 
+static void aacdec_post_select(__a_unused struct sched *s, struct task *t)
+{
+       struct filter_node *fn = container_of(t, struct filter_node, task);
+       struct btr_node *btrn = fn->btrn;
+       struct private_aacdec_data *padd = fn->private_data;
+       int i, ret;
+       unsigned char *p, *inbuf, *outbuffer;
+       char *btr_buf;
+       size_t len, skip, consumed = 0, loaded, iqs;
+
+next_buffer:
+       t->error = 0;
+       ret = btr_node_status(btrn, fn->min_iqs);
+       if (ret < 0)
+               goto err;
+       if (ret == 0)
+               return;
+       btr_merge(btrn, fn->min_iqs);
+       len = btr_next_buffer(btrn, (char **)&inbuf);
+       iqs = btr_get_input_queue_size(btrn);
+       if (!padd->initialized) {
+               unsigned long rate = 0;
+               unsigned char channels = 0;
+               ret = aac_find_esds(inbuf, len, &skip, &padd->decoder_length);
+               if (ret < 0) {
+                       PARA_INFO_LOG("%s\n", para_strerror(-ret));
+                       ret = NeAACDecInit(padd->handle, inbuf,
+                               len, &rate, &channels);
+                       PARA_INFO_LOG("decoder init: %d\n", ret);
+                       if (ret < 0) {
+                               ret = -E_AACDEC_INIT;
+                               goto out;
+                       }
+                       consumed = ret;
+               } else {
+                       PARA_INFO_LOG("decoder len: %lu\n",
+                               padd->decoder_length);
+                       consumed += skip;
+                       p = inbuf + consumed;
+                       ret = -E_AACDEC_INIT;
+                       if (NeAACDecInit2(padd->handle, p,
+                                       padd->decoder_length, &rate,
+                                       &channels) < 0)
+                               goto out;
+               }
+               padd->samplerate = rate;
+               padd->channels = channels;
+               PARA_INFO_LOG("rate: %u, channels: %d\n",
+                       padd->samplerate, padd->channels);
+               padd->initialized = 1;
+       }
+       if (padd->decoder_length > 0) {
+               consumed = 0;
+               if (!padd->entry) {
+                       ret = aac_find_entry_point(inbuf + consumed,
+                               len - consumed, &skip);
+                       if (ret < 0) {
+                               ret = len;
+                               goto out;
+                       }
+                       consumed += skip;
+                       padd->entry = ret;
+                       PARA_INFO_LOG("entry: %zu\n", padd->entry);
+               }
+               ret = len;
+               if (padd->consumed_total + len < padd->entry)
+                       goto out;
+               if (padd->consumed_total < padd->entry)
+                       consumed = padd->entry - padd->consumed_total;
+       }
+       for (; consumed < len; consumed++)
+               if ((inbuf[consumed] & 0xfe) == 0x20)
+                       break;
+       if (consumed >= len)
+               goto success;
+       p = inbuf + consumed;
+       //PARA_CRIT_LOG("consumed: %zu (%zu + %zu), have: %zu\n", padd->consumed_total + consumed,
+       //      padd->consumed_total, consumed, len - consumed);
+       outbuffer = NeAACDecDecode(padd->handle, &padd->frame_info, p,
+               len - consumed);
+       if (padd->frame_info.error) {
+               int err = padd->frame_info.error;
+               ret = -E_AAC_DECODE;
+               if (padd->error_count++ > MAX_ERRORS)
+                       goto err;
+               PARA_ERROR_LOG("frame_error: %d (%s), consumed: %zu + %zd + %lu\n",
+                       err, NeAACDecGetErrorMessage(padd->frame_info.error),
+                       padd->consumed_total, consumed,
+                       padd->frame_info.bytesconsumed);
+               PARA_ERROR_LOG("%s\n", NeAACDecGetErrorMessage(
+                       padd->frame_info.error));
+               consumed++; /* catch 21 */
+               goto success;
+       }
+       padd->error_count = 0;
+       //PARA_CRIT_LOG("decoder ate %lu\n", padd->frame_info.bytesconsumed);
+       consumed += padd->frame_info.bytesconsumed;
+       ret = consumed;
+       if (!padd->frame_info.samples)
+               goto out;
+       btr_buf = para_malloc(2 * padd->frame_info.samples);
+       loaded = 0;
+       for (i = 0; i < padd->frame_info.samples; i++) {
+               short sh = ((short *)outbuffer)[i];
+               write_int16_host_endian(btr_buf + loaded, sh);
+               loaded += 2;
+       }
+       btr_add_output(btr_buf, loaded, btrn);
+success:
+       ret = consumed;
+out:
+       if (ret >= 0) {
+               padd->consumed_total += ret;
+               btr_consume(btrn, ret);
+               goto next_buffer;
+       }
+err:
+       assert(ret < 0);
+       t->error = ret;
+       btr_remove_node(btrn);
+}
+
 /**
  * the init function of the aacdec filter
  *
@@ -195,4 +342,7 @@ void aacdec_filter_init(struct filter *f)
        f->open = aacdec_open;
        f->convert = aacdec;
        f->close = aacdec_close;
+       f->pre_select = generic_filter_pre_select;
+       f->post_select = aacdec_post_select;
+       f->execute = aacdec_execute;
 }