ok
Dependencies: mbed AnalogIn_Diff_ok MovingAverage_ok
trms/trms.cpp
- Committer:
- fblanc
- Date:
- 2016-01-08
- Revision:
- 2:f82c6978c589
File content as of revision 2:f82c6978c589:
#include "trms.h" #define DEBUG 1 //Debug is disabled by default #if (defined(DEBUG)) #define DBG(x, ...) std::printf("[trms : DBG]"x"\r\n", ##__VA_ARGS__); #define WARN(x, ...) std::printf("[trms : WARN]"x"\r\n", ##__VA_ARGS__); #define ERR(x, ...) std::printf("[trms : ERR]"x"\r\n", ##__VA_ARGS__); #define INFO(x, ...) std::printf("[trms : INFO]"x"\r\n", ##__VA_ARGS__); #else #define DBG(x, ...) #define WARN(x, ...) #define ERR(x, ...) #define INFO(x, ...) #endif trms::trms(int adc_Diff_number_chan) : AnalogIn_Diff(adc_Diff_number_chan), vtrms(NSAMPLE,UAC_NON2) { timer_min.stop(); timer_max.stop(); timer_min.reset(); timer_max.reset(); _time_min=0; F_timer_min=false; _time_max=0; F_timer_max=false; _min=UAC_NON2; _max=UAC_NON2; gain=GAIN; offset=0.0; _flag_trms=false; DBG("Unon =%0.0fV",UAC_NON); DBG("RAW Umax2 =%d",UAC_MAX2); DBG("RAW Umin2 =%d",UAC_MIN2); DBG("Gain =%f",gain); DBG("Freq UAC=%dHz",FREQ); DBG("Sample =%d",NSAMPLE); DBG("Sample =%dus",TSAMPLE); } float trms::read_rms() { return (sqrt((float)vtrms.GetAverage())*gain-offset); } /** * @brief Destructor. */ trms::~trms() { flipperadc_Diff.detach(); } void trms::start() { flipperadc_Diff.attach_us<trms>(this,&trms::flipadc_Diff, TSAMPLE); } void trms::flipadc_Diff() { int16_t val_i16; uint32_t val2_ui32; val_i16=read_raws16(); vtrms.Insert(val_i16*val_i16); val2_ui32=vtrms.GetAverage(); //MIN if(val2_ui32<UAC_MIN2 && F_timer_min ==false) { timer_min.start(); F_timer_min = true; } if(F_timer_min ==true) { if(val2_ui32>UAC_MIN2STOP ) { timer_min.stop(); F_timer_min = false; _flag_trms=true; //????????????????? _flag_min=true; } else if(timer_min.read_ms()>20) { _time_min=timer_min.read_ms(); _min=MIN(val2_ui32,_min); } //max if(val2_ui32<UAC_MAX2STOP && F_timer_max ==true) { timer_max.stop(); F_timer_max = false; _flag_trms=true; _flag_max=true; } if(val2_ui32>UAC_MAX2 && F_timer_max ==false) { timer_max.start(); F_timer_max = true; } if(timer_max.read_ms()>20 && F_timer_max ==true) { _time_max=timer_max.read_ms(); _max=MAX(val2_ui32,_max); } } } bool trms::flag (float *rms, uint32_t *time) { bool old_flag =_flag_trms; if(_flag_trms==true) { _flag_trms=false; if(_flag_min==true) { *time=_time_min; timer_min.reset(); *rms=(sqrt((float)_min)*gain-offset); _min=UAC_NON2; _flag_min=false; } else if(_flag_max==true) { *time=_time_max; timer_max.reset(); *rms=(sqrt((float)_max)*gain-offset); _max=UAC_NON2; _flag_max=false; } } else { *rms=read_rms(); *time=0; } return old_flag; } void trms::set_gain(float _gain) { gain=_gain; } void trms::set_offset(float _offset) { offset=_offset; } float trms::get_gain() { return gain; } float trms::get_offset() { return offset; }