ok
Dependencies: mbed AnalogIn_Diff_ok MovingAverage_ok
Diff: trms/trms.cpp
- Revision:
- 2:f82c6978c589
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/trms/trms.cpp Fri Jan 08 08:09:34 2016 +0000 @@ -0,0 +1,186 @@ +#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; +}