X-Git-Url: http://git.tuebingen.mpg.de/?p=paraslash.git;a=blobdiff_plain;f=amp_filter.c;h=e91791bf8655e58cbc494901ad232fc1787cbe10;hp=2f05260157de9e7103d1a717812981773489fd59;hb=c282c836791cedf57c128555af90af37c7c01c05;hpb=89a0e510df07bc7210ca9e73381763fdd183df75

diff --git a/amp_filter.c b/amp_filter.c
index 2f052601..e91791bf 100644
--- a/amp_filter.c
+++ b/amp_filter.c
@@ -1,15 +1,20 @@
 /*
- * Copyright (C) 2008 Andre Noll <maan@systemlinux.org>
+ * Copyright (C) 2009 Andre Noll <maan@systemlinux.org>
  *
  * Licensed under the GPL v2. For licencing details see COPYING.
  */
 
 /** \file amp_filter.c Paraslash's amplify filter. */
 
+#include <regex.h>
+#include <stdbool.h>
+
 #include "para.h"
 #include "amp_filter.cmdline.h"
 #include "list.h"
 #include "sched.h"
+#include "ggo.h"
+#include "buffer_tree.h"
 #include "filter.h"
 #include "string.h"
 #include "error.h"
@@ -29,19 +34,29 @@ struct private_amp_data {
 
 static ssize_t amp_convert(char *inbuf, size_t inbuf_len, struct filter_node *fn)
 {
-	size_t i, length = PARA_MIN((inbuf_len / 2) * 2,
-		(fn->bufsize - fn->loaded) / 2 * 2);
+	size_t i, length = PARA_MIN((inbuf_len / 2),
+		(fn->bufsize - fn->loaded) / 2);
 	struct private_amp_data *pad = fn->private_data;
 	int16_t *ip = (int16_t *)inbuf, *op = (int16_t *)(fn->buf + fn->loaded);
+	int factor = 64 + pad->amp;
 
 	if (!length)
 		return 0;
-	for (i = 0; i < length / 2; i++) {
-		int x = (PARA_ABS(*ip) * (64 + pad->amp)) >> 6;
-		*op++ = *ip++ > 0? PARA_MIN(x, 32767) : PARA_MAX(-x, -32768);
+
+	if (pad->amp == 0) {
+		memcpy(op, ip, length * 2);
+		goto out;
+	}
+	for (i = 0; i < length; i++) {
+		int x = (ip[i] * factor) >> 6;
+
+		op[i] = x;
+		if (op[i] != x)
+			op[i] = (x >= 32768)? 32767 : -32768;
 	}
-	fn->loaded += length;
-	return length;
+out:
+	fn->loaded += length * 2;
+	return length * 2;
 }
 
 static void amp_close(struct filter_node *fn)
@@ -75,16 +90,77 @@ static void amp_open(struct filter_node *fn)
 
 	pad->conf = fn->conf;
 	fn->private_data = pad;
-	if (!pad->conf->amp_given && stat_item_values[SI_AMPLIFICATION]) {
-		int i = SI_AMPLIFICATION;
-		char *s = stat_item_values[i] + strlen(status_item_list[i]) + 1;
-		sscanf(s, "%u", &pad->amp);
-	} else
+	fn->min_iqs = 2;
+	if (!pad->conf->amp_given && stat_item_values[SI_AMPLIFICATION])
+		sscanf(stat_item_values[SI_AMPLIFICATION], "%u", &pad->amp);
+	else
 		pad->amp = pad->conf->amp_arg;
 	fn->bufsize = AMP_CHUNK_SIZE;
 	fn->buf = para_malloc(fn->bufsize);
 }
 
+static void amp_post_select(__a_unused struct sched *s, struct task *t)
+{
+	struct filter_node *fn = container_of(t, struct filter_node, task);
+	struct private_amp_data *pad = fn->private_data;
+	struct btr_node *btrn = fn->btrn;
+	int ret, factor = 64 + pad->amp;
+	size_t i, in_bytes, len;
+	int16_t *in, *out;
+	bool inplace = btr_inplace_ok(btrn);
+
+	if (pad->amp == 0) { /* no amplification */
+		t->error = -E_AMP_ZERO_AMP;
+		btr_splice_out_node(btrn);
+		amp_close(fn);
+		return;
+	}
+next_buffer:
+	ret = btr_node_status(btrn, fn->min_iqs, BTR_NT_INTERNAL);
+	if (ret < 0)
+		goto err;
+	if (ret == 0)
+		return;
+	btr_merge(btrn, fn->min_iqs);
+	in_bytes = btr_next_buffer(btrn, (char **)&in);
+	len = in_bytes / 2;
+	if (len == 0) { /* eof and in_bytes == 1 */
+		ret = -E_AMP_EOF;
+		goto err;
+	}
+
+	if (inplace)
+		out = in;
+	else
+		out = para_malloc(len * 2);
+
+	for (i = 0; i < len; i++) {
+		int x = (in[i] * factor) >> 6;
+
+		out[i] = x;
+		if (out[i] != x) /* overflow, clip */
+			out[i] = (x >= 0)? 32767 : -32768;
+	}
+
+	if (inplace)
+		btr_pushdown_one(btrn);
+	else {
+		btr_consume(btrn, len * 2);
+		btr_add_output((char *)out, len * 2, btrn);
+	}
+	t->error = 0;
+	goto next_buffer;
+err:
+	assert(ret < 0);
+	t->error = ret;
+	btr_remove_node(btrn);
+}
+
+static void amp_free_config(void *conf)
+{
+	amp_cmdline_parser_free(conf);
+}
+
 /**
  * The init function of the amplify filter.
  *
@@ -92,9 +168,18 @@ static void amp_open(struct filter_node *fn)
  */
 void amp_filter_init(struct filter *f)
 {
+	struct amp_filter_args_info dummy;
+
+	amp_cmdline_parser_init(&dummy);
 	f->open = amp_open;
 	f->close = amp_close;
 	f->convert = amp_convert;
-	f->print_help = amp_cmdline_parser_print_help;
+	f->pre_select = generic_filter_pre_select;
+	f->post_select = amp_post_select;
 	f->parse_config = amp_parse_config;
+	f->free_config = amp_free_config;
+	f->help = (struct ggo_help) {
+		.short_help = amp_filter_args_info_help,
+		.detailed_help = amp_filter_args_info_detailed_help
+	};
 }