From 40c9245a9aa656b4ef1d9962ca57aa967db58e28 Mon Sep 17 00:00:00 2001
From: Tom Rondeau
Date: Tue, 12 Feb 2013 18:22:01 -0500
Subject: analog: fix a floating point accuracy issue in the CTCSS squelch
 block.

---
 gr-analog/lib/ctcss_squelch_ff_impl.cc | 7 ++++---
 1 file changed, 4 insertions(+), 3 deletions(-)

(limited to 'gr-analog')

diff --git a/gr-analog/lib/ctcss_squelch_ff_impl.cc b/gr-analog/lib/ctcss_squelch_ff_impl.cc
index db49b4f6e..60cd94fdb 100644
--- a/gr-analog/lib/ctcss_squelch_ff_impl.cc
+++ b/gr-analog/lib/ctcss_squelch_ff_impl.cc
@@ -115,11 +115,12 @@ namespace gr {
       d_goertzel_c.input(in);
       d_goertzel_r.input(in);
 
+      float rounder = 100000;
       float d_out_l, d_out_c, d_out_r;
       if(d_goertzel_c.ready()) {
-	d_out_l = abs(d_goertzel_l.output());
-	d_out_c = abs(d_goertzel_c.output());
-	d_out_r = abs(d_goertzel_r.output());
+	d_out_l = floor(rounder*abs(d_goertzel_l.output()))/rounder;
+	d_out_c = floor(rounder*abs(d_goertzel_c.output()))/rounder;
+	d_out_r = floor(rounder*abs(d_goertzel_r.output()))/rounder;
 
 	//printf("d_out_l=%f d_out_c=%f d_out_r=%f\n", d_out_l, d_out_c, d_out_r);
 	d_mute = (d_out_c < d_level || d_out_c < d_out_l || d_out_c < d_out_r);
-- 
cgit