From 876a591a66acdd7bbfc7b419cbcd087fb5d76692 Mon Sep 17 00:00:00 2001
From: Jared Boone <jboone@earfeast.com>
Date: Mon, 20 Jul 2015 09:33:56 -0700
Subject: [PATCH] Add IIR execute_in_place()

---
 firmware/baseband/dsp_iir.hpp | 11 ++++++++---
 firmware/baseband/main.cpp    |  6 +++---
 2 files changed, 11 insertions(+), 6 deletions(-)

diff --git a/firmware/baseband/dsp_iir.hpp b/firmware/baseband/dsp_iir.hpp
index 40c642ed..9a7602e9 100644
--- a/firmware/baseband/dsp_iir.hpp
+++ b/firmware/baseband/dsp_iir.hpp
@@ -39,12 +39,17 @@ public:
 	{
 	}
 
-	void execute(buffer_s16_t buffer) {
-		for(size_t i=0; i<buffer.count; i++) {
-			buffer.p[i] = execute_sample(buffer.p[i]);
+	void execute(buffer_s16_t buffer_in, buffer_s16_t buffer_out) {
+		// TODO: Assert that buffer_out.count == buffer_in.count.
+		for(size_t i=0; i<buffer_out.count; i++) {
+			buffer_out.p[i] = execute_sample(buffer_in.p[i]);
 		}
 	}
 
+	void execute_in_place(buffer_s16_t buffer) {
+		execute(buffer, buffer);
+	}
+
 private:
 	const std::array<float, 3> b;
 	const std::array<float, 3> a;
diff --git a/firmware/baseband/main.cpp b/firmware/baseband/main.cpp
index aa879c65..902bb7a2 100755
--- a/firmware/baseband/main.cpp
+++ b/firmware/baseband/main.cpp
@@ -453,7 +453,7 @@ public:
 		 * -> 48kHz int16_t[32] */
 		auto audio = demod.execute(channel, work_audio_buffer);
 
-		audio_hpf.execute(audio);
+		audio_hpf.execute_in_place(audio);
 		feed_audio_stats(audio);
 		fill_audio_buffer(audio);
 	}
@@ -502,7 +502,7 @@ public:
 		 * -> 48kHz int16_t[32] */
 		auto audio = demod.execute(channel, work_audio_buffer);
 
-		audio_hpf.execute(audio);
+		audio_hpf.execute_in_place(audio);
 		feed_audio_stats(audio);
 		fill_audio_buffer(audio);
 	}
@@ -565,7 +565,7 @@ public:
 		auto audio = audio_filter.execute(audio_2fs, work_audio_buffer);
 
 		/* -> 48kHz int16_t[32] */
-		audio_hpf.execute(audio);
+		audio_hpf.execute_in_place(audio);
 		feed_audio_stats(audio);
 		fill_audio_buffer(audio);
 	}