| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  | /*  fmd.h
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | This file is part of a program that implements a Software-Defined Radio. | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | Copyright (C) 2013 Warren Pratt, NR0V | 
					
						
							|  |  |  | Copyright (C) 2024 Edouard Griffiths, F4EXB Adapted to SDRangel | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | This program is free software; you can redistribute it and/or | 
					
						
							|  |  |  | modify it under the terms of the GNU General Public License | 
					
						
							|  |  |  | as published by the Free Software Foundation; either version 2 | 
					
						
							|  |  |  | of the License, or (at your option) any later version. | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | This program is distributed in the hope that it will be useful, | 
					
						
							|  |  |  | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
					
						
							|  |  |  | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
					
						
							|  |  |  | GNU General Public License for more details. | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | You should have received a copy of the GNU General Public License | 
					
						
							|  |  |  | along with this program; if not, write to the Free Software | 
					
						
							|  |  |  | Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA. | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | The author can be reached by email at | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | warren@wpratt.com | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #ifndef wdsp_fmd_h
 | 
					
						
							|  |  |  | #define wdsp_fmd_h
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2024-07-28 11:36:45 +02:00
										 |  |  | #include <vector>
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  | #include "export.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | namespace WDSP { | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class FIRCORE; | 
					
						
							|  |  |  | class SNOTCH; | 
					
						
							|  |  |  | class WCPAGC; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class WDSP_API FMD | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | public: | 
					
						
							|  |  |  |     int run; | 
					
						
							|  |  |  |     int size; | 
					
						
							| 
									
										
										
										
											2024-06-25 03:50:48 +02:00
										 |  |  |     float* in; | 
					
						
							|  |  |  |     float* out; | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double rate; | 
					
						
							|  |  |  |     double f_low;                       // audio low cutoff
 | 
					
						
							|  |  |  |     double f_high;                      // audio high cutoff
 | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // pll
 | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double fmin;                        // pll - minimum carrier freq to lock
 | 
					
						
							|  |  |  |     double fmax;                        // pll - maximum carrier freq to lock
 | 
					
						
							|  |  |  |     double omega_min;                   // pll - minimum lock check parameter
 | 
					
						
							|  |  |  |     double omega_max;                   // pll - maximum lock check parameter
 | 
					
						
							|  |  |  |     double zeta;                        // pll - damping factor; as coded, must be <=1.0
 | 
					
						
							|  |  |  |     double omegaN;                      // pll - natural frequency
 | 
					
						
							|  |  |  |     double phs;                         // pll - phase accumulator
 | 
					
						
							|  |  |  |     double omega;                       // pll - locked pll frequency
 | 
					
						
							|  |  |  |     double fil_out;                     // pll - filter output
 | 
					
						
							|  |  |  |     double g1, g2;                      // pll - filter gain parameters
 | 
					
						
							|  |  |  |     double pllpole;                     // pll - pole frequency
 | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // for dc removal
 | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double tau; | 
					
						
							|  |  |  |     double mtau; | 
					
						
							|  |  |  |     double onem_mtau; | 
					
						
							|  |  |  |     double fmdc; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // pll audio gain
 | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double deviation; | 
					
						
							|  |  |  |     double again; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // for de-emphasis filter
 | 
					
						
							| 
									
										
										
										
											2024-07-28 11:36:45 +02:00
										 |  |  |     std::vector<float> audio; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     FIRCORE *pde; | 
					
						
							|  |  |  |     int nc_de; | 
					
						
							|  |  |  |     int mp_de; | 
					
						
							|  |  |  |     // for audio filter
 | 
					
						
							|  |  |  |     FIRCORE *paud; | 
					
						
							|  |  |  |     int nc_aud; | 
					
						
							|  |  |  |     int mp_aud; | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double afgain; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // CTCSS removal
 | 
					
						
							|  |  |  |     SNOTCH *sntch; | 
					
						
							|  |  |  |     int sntch_run; | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double ctcss_freq; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // detector limiter
 | 
					
						
							|  |  |  |     WCPAGC *plim; | 
					
						
							|  |  |  |     int lim_run; | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |     double lim_gain; | 
					
						
							|  |  |  |     double lim_pre_gain; | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2024-07-26 19:10:53 +02:00
										 |  |  |     FMD( | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |         int run, | 
					
						
							|  |  |  |         int size, | 
					
						
							| 
									
										
										
										
											2024-06-25 03:50:48 +02:00
										 |  |  |         float* in, | 
					
						
							|  |  |  |         float* out, | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |         int rate, | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |         double deviation, | 
					
						
							|  |  |  |         double f_low, | 
					
						
							|  |  |  |         double f_high, | 
					
						
							|  |  |  |         double fmin, | 
					
						
							|  |  |  |         double fmax, | 
					
						
							|  |  |  |         double zeta, | 
					
						
							|  |  |  |         double omegaN, | 
					
						
							|  |  |  |         double tau, | 
					
						
							|  |  |  |         double afgain, | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |         int sntch_run, | 
					
						
							| 
									
										
										
										
											2024-07-06 03:25:41 +02:00
										 |  |  |         double ctcss_freq, | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |         int nc_de, | 
					
						
							|  |  |  |         int mp_de, | 
					
						
							|  |  |  |         int nc_aud, | 
					
						
							|  |  |  |         int mp_aud | 
					
						
							|  |  |  |     ); | 
					
						
							| 
									
										
										
										
											2024-07-28 11:36:45 +02:00
										 |  |  |     FMD(const FMD&) = delete; | 
					
						
							| 
									
										
										
										
											2024-07-29 08:57:02 +02:00
										 |  |  |     FMD& operator=(const FMD& other) = delete; | 
					
						
							| 
									
										
										
										
											2024-07-26 19:10:53 +02:00
										 |  |  |     ~FMD(); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     void flush(); | 
					
						
							|  |  |  |     void execute(); | 
					
						
							|  |  |  |     void setBuffers(float* in, float* out); | 
					
						
							|  |  |  |     void setSamplerate(int rate); | 
					
						
							|  |  |  |     void setSize(int size); | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  |     // RXA Properties
 | 
					
						
							| 
									
										
										
										
											2024-07-26 19:10:53 +02:00
										 |  |  |     void setDeviation(double deviation); | 
					
						
							|  |  |  |     void setCTCSSFreq(double freq); | 
					
						
							|  |  |  |     void setCTCSSRun(int run); | 
					
						
							|  |  |  |     void setNCde(int nc); | 
					
						
							|  |  |  |     void setMPde(int mp); | 
					
						
							|  |  |  |     void setNCaud(int nc); | 
					
						
							|  |  |  |     void setMPaud(int mp); | 
					
						
							|  |  |  |     void setLimRun(int run); | 
					
						
							|  |  |  |     void setLimGain(double gaindB); | 
					
						
							|  |  |  |     void setAFFilter(double low, double high); | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  | private: | 
					
						
							| 
									
										
										
										
											2024-07-26 19:10:53 +02:00
										 |  |  |     void calc(); | 
					
						
							|  |  |  |     void decalc(); | 
					
						
							| 
									
										
										
										
											2024-06-16 11:31:13 +02:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | } // namespace WDSP
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #endif
 |