From 8453741252655499d20fe358080bed72233bc1f1 Mon Sep 17 00:00:00 2001
From: Jared Boone <jboone@earfeast.com>
Date: Mon, 28 Dec 2015 16:33:26 -0800
Subject: [PATCH] Saturate IIR filter output to int16_t.

---
 firmware/baseband/dsp_iir.hpp | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/firmware/baseband/dsp_iir.hpp b/firmware/baseband/dsp_iir.hpp
index 8fb12f05..895cb312 100644
--- a/firmware/baseband/dsp_iir.hpp
+++ b/firmware/baseband/dsp_iir.hpp
@@ -45,7 +45,9 @@ public:
 	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]);
+			const int32_t output_sample = execute_sample(buffer_in.p[i]);
+			const int32_t output_sample_saturated = __SSAT(output_sample, 16);
+			buffer_out.p[i] = output_sample_saturated;
 		}
 	}