Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
PLC_reg.c
- Committer:
- Kovalev_D
- Date:
- 2018-01-05
- Revision:
- 227:2774b56bfab0
- Parent:
- 129:406995a91322
File content as of revision 227:2774b56bfab0:
/****************************************Copyright (c)**************************************************** **--------------File Info--------------------------------------------------------------------------------- ** File name: PLC_reg.c ** Last modified Date: 2011-09-26 ** Last Version: V1.00 ** Descriptions: Routines for system of perimeter regulating unit ** **-------------------------------------------------------------------------------------------------------- ** Created by: Electrooptica Incorp. ** Created date: 2011-09-26 ** Version: V1.00 ** Descriptions: ** **-------------------------------------------------------------------------------------------------------- *********************************************************************************************************/ #include "Global.h" #define CONFIG_HFO_REG //r. изменяем коэффициент передачи контура ГВЧ от номинального на время обнуления #define WP_TRANSITION_ENA // //e.--- constants for the CPLC regulator ------------------------------------------------------- //r.--- константы для контура СРП ------------------------------------------------------- #define PLC_SHIFT (6) #define PLC_PHASE_DET_SHIFT (18) //e. 18 - for analog output //r. 18 - для аналогового #define PLC_RESET_THRESHOLD (-3276) //e. correspond to the voltage +1.2 Volts //r. соответствует напряжению +1.2 вольта #define WP_REG32MAX_SATURATION (32767 << PLC_SHIFT) #define WP_REG32MIN_NEW_SATURATION (PLC_RESET_THRESHOLD << PLC_SHIFT) #define WP_TMP_THRESHOLD (7) //e. temperature threshold, defining heats up or cool down the device //r. температурный порог, определяющий нагревается или охлаждается прибор #define debugPLC int WP_reg32; int WP_Phase_Det; //e. output of the phase detector of the CPLC (in a digital kind)//r. выход фазового детектора СРП (в цифровом виде) int WP_reset_heating; //e. voltage of reset at heating //r. напряжение сброса при нагревании int WP_reset_cooling; //e. voltage of reset at cooling //r. напряжение сброса при охлаждении int MaxDelayPLC; int sin_func[100]; int phase_Digital; int WP_PhaseDetectorRate(int PhaseDetInput, int IntegrateTime); /****************************************************************************** ** Function name: init_PLC ** ** Descriptions: Initialization procedure for PLC regulator ** ** Parameters: None ** Returned value: None ** ******************************************************************************/ void init_PLC(void) { /* int i; //( 1,2 вольта) if (Device_blk.Str.WP_reset < PLC_RESET_THRESHOLD) //e. напряжение после сброса на нагревателе не должно превышать 1,2 вольта. //(исходное значение регулятора СРП (после сброса)) < (-3276). { Device_blk.Str.WP_reset = PLC_RESET_THRESHOLD + 1;//(-3275) } //напряжение на СРП = (мин. значение на нагревателе + мах. значение на нагревателе)/2 Output.Str.WP_reg = (Device_blk.Str.WP_rup + Device_blk.Str.WP_rdw) >> 1; //e. WP_reg start voltage is (WP_rup - WP_rdw)/2 // напряжение на СРП << 6 WP_reg32 = Output.Str.WP_reg<<PLC_SHIFT; if ((Device_blk.Str.PI_b3>100)||(Device_blk.Str.PI_b3<10)) //e. Если требуемая частота модулятора СРП больше 1kHz или меньше 100Hz Device_blk.Str.PI_b3 = 40; //e. Установить частоту в 250Hz (частота дребездения) for (i = 0; i<Device_blk.Str.PI_b3; i++) { //e. Сканирование СРП сигнала float temp = sin((float)i*2.0*PI/(float)Device_blk.Str.PI_b3); /// вычисление значений синуса /// для частоты модулятора срп (PI_b3), sin_func[i] = (int)(temp*32767); /// и калибровка этих значений для АЦП. if (sin_func[i] < 0) sin_func[i] += 65536; } //e. calculation of filter coefficients for PLC // 250 Hz 10 KHz init_BandPass( 1.0/(float)Device_blk.Str.PI_b3, 10.0/(float)(DEVICE_SAMPLE_RATE_HZ), PLC); //полософой фильтр для выделения частоты колебания модулятора //и определение коэфициентов(aPLC[0-2] и bPLC[0-2]) //(дребездение срп для определения греть или охлождать основной элемент управления.) Device_blk.Str.WP_scl <<= 1; //e. during fist 10 seconds after start we state Device_blk.Str.WP_scl = 2*Device_blk.Str.WP_scl // первые 10 секунд работать с коэфициентом передачи * 2 MaxDelayPLC = Device_blk.Str.PI_b3>>1; //e. max expected delay for phase detector output*/ } // init_PLC /****************************************************************************** ** Function name: PLC_MeanderDelay ** ** Descriptions: Outgoing of the delayed meander signal for the PLC regulator ** ** parameters: Input value ** Returned value: Delayed value ** ******************************************************************************/ int PLC_MeanderDelay(int flag) { /* static int poz_counter = 0, neg_counter = 0, flg_delay; if (Device_blk.Str.WP_ref == 0) { return (flag); } //e. check whether delay exceeds the greatest possible value //r. проверка не превосходит ли задержка максимально возможную if (Device_blk.Str.WP_ref > MaxDelayPLC) { Device_blk.Str.WP_ref = MaxDelayPLC; } if (flag) { //e. outgoing poz_sin_flag flag, which delayed by the WP_ref //r. формирование задержанного на величину WP_ref флага poz_sin_flag neg_counter = 0; poz_counter++; } else { poz_counter = 0; neg_counter++; } if (poz_counter == Device_blk.Str.WP_ref) { flg_delay = 0; } if (neg_counter == Device_blk.Str.WP_ref) { flg_delay = 1; } return (flg_delay);*/ } /****************************************************************************** ** Function name: clc_PLC ** ** Descriptions: Procedure of initial processing for the CPLC regulator ** ** parameters: None ** Returned value: None ** ******************************************************************************/ /*void clc_PLC(void) { static int is_zeroing = 0; static int zero_delay = 0; // static int WP_DelaySin_Array[21] = {0}; // int phase_Digital; int poz_sin_flag; int poz_sin_flag_delayed; static int plc_reset32; static enum { //r. состояние линейного перехода при обнулении СРП FINISHED, //r. линейный переход завершен TRANS_HEATING, //r. переход выполняется при нагревании TRANS_COOLING //r. переход выполняется при охлаждении } plc_transiton = FINISHED; // int i; if (Output.Str.WP_sin >= 32768) { poz_sin_flag = 0; } else { poz_sin_flag = 1; } //r. полосовой фильтр для контура СРП WP_Phase_Det = PLC_PhaseDetFilt(Output.Str.WP_sin/Input.StrIn.WP_sel);*/ /* if (WP_Phase_Det >0) { //r. WP_sel>0 phase_Digital = 1; } else { phase_Digital = -1; } // from this WP_Phase_Det - modulated signal like LIM_DIG poz_sin_flag_delayed = PLC_MeanderDelay(poz_sin_flag); if(poz_sin_flag_delayed) { WP_Phase_Det = -WP_Phase_Det; phase_Digital = -phase_Digital; } // from this WP_Phase_Det - demodulated signal like LIDEM_DIG if (!is_zeroing) { //r. Не пора выполнять обнуление //r. нет обнуления if ((WP_reg32 > (Device_blk.Str.WP_rup << PLC_SHIFT)) && IsHeating) { //r. происходит нагревание is_zeroing = 1; //r. напряжение сброса при нагревании WP_reset_heating = CPL_reset_calc(Device_blk.Str.WP_reset, Device_blk.Str.K_WP_rst_heating, Temp_Aver, Device_blk.Str.TemperNormal); plc_transiton = TRANS_HEATING; plc_reset32 = WP_reset_heating << PLC_SHIFT;; Device_blk.Str.HF_scl = Device_blk.Str.HF_scl_2; //r. изменяем коэффициент передачи контура ГВЧ от номинального на время обнуления } else if ((WP_reg32 < (Device_blk.Str.WP_rdw << PLC_SHIFT)) && !IsHeating) { //r. охлаждение is_zeroing = 1; //r. напряжение сброса при охлаждении WP_reset_cooling = CPL_reset_calc(Device_blk.Str.WP_reset2, Device_blk.Str.K_WP_rst_cooling, Temp_Aver, Device_blk.Str.TemperNormal); plc_transiton = TRANS_COOLING; plc_reset32 = WP_reset_cooling << PLC_SHIFT; Device_blk.Str.HF_scl = Device_blk.Str.HF_scl_2; //r. изменяем коэффициент передачи контура ГВЧ от номинального на время обнуления } else //r. пороги не превышены, обычная работа контура WP_reg32 = L_mac(WP_reg32, phase_Digital, Device_blk.Str.WP_scl ); // WP_reg32 += phase_Digital * Device_blk.Str.WP_scl; } else { //r. флаг установлен (1) - режим обнуления if (plc_transiton != FINISHED) { if (plc_transiton == TRANS_HEATING) { WP_reg32 = L_sub(WP_reg32, Device_blk.Str.WP_transition_step); // WP_reg32 -= Device_blk.Str.WP_transition_step; if (WP_reg32 < plc_reset32) { zero_delay = 0; plc_transiton = FINISHED; //r.false; WP_reg32 = plc_reset32; } } else { // plc_transiton == TRANS_COOLING WP_reg32 = L_add(WP_reg32, Device_blk.Str.WP_transition_step); // WP_reg32 += Device_blk.Str.WP_transition_step; if (WP_reg32 > plc_reset32) { zero_delay = 0; plc_transiton = FINISHED; //r.false; WP_reg32 = plc_reset32; } } } else if (zero_delay < Device_blk.Str.WP_mdy) { zero_delay++; } else { //e. resetting was completed //r. обнуление закончилось is_zeroing = 0; //e. save the temperature for further comparison //r. запоминаем температуру для дальнейшего сравнения // TempOfReset = Temp_Aver; //r.x. Temp5_Aver; //r. Tmp_Out[TSENS_NUMB]; // T4; //r.x Zero_Numb_dbg++; // так можно подсчитывать число обнулений // DithFreqRangeCalc(); //e. calculation of range of the division factor for the dither drive frequency, depending on current temperature //r. расчет границ коэффициента деления для частоты вибропривода, зависящих от текущей температуры } } Saturation(WP_reg32, WP_REG32MAX_SATURATION, WP_REG32MIN_NEW_SATURATION); //e. the minimum corresponds to a small negative number, appropriate to PLC_RESET_THRESHOLD //r. минимум соответствует небольшому отрицательному числу, соотв-му PLC_RESET_THRESHOLD if ( loop_is_closed(WP_REG_ON) ) { //e. the regulator loop is closed //r. контур замкнут Output.Str.WP_reg = (int)(WP_reg32 >> PLC_SHIFT); //e. we use as controlling - voltages of the integrator //r. используем как управляющее - напряжения интегратора } else { //e. the regulator loop is open //r. контур разомкнут WP_reg32 = Output.Str.WP_reg << PLC_SHIFT; //e. set the previous value of the WP_reg //r. присваиваем предыдущее значение WP_reg } //e. integartion of output of the PD of the CPLC regulator for the technological output on the Rate command //r. интегрирование выхода ФД контура СРП для технологического вывода по команде Rate Output.Str.WP_pll = WP_PhaseDetectorRate( WP_Phase_Det, time_1_Sec); } // clc_PLC */ /****************************************************************************** ** Function name: Signal_2_Oscill ** ** Descriptions: Procedure of analog worm output ** ** parameters: Type of output ** Returned value: code to DAC ** ******************************************************************************/ int Signal_2_Oscill() //e. the signal for the control by scope on DAC output (was DS) //r. сигнал для контроля осциллографом на выходе ЦАП (бывший ДУП) { // Scope_Mode var not used now, reserved for future applications return (-WP_Phase_Det << 2); } // Signal_2_Oscill /****************************************************************************** ** Function name: clc_WP_sin ** ** Descriptions: Procedure of scan signal generating ** ** parameters: None ** Returned value: Current code for scan signal DAC of PLC ** ******************************************************************************/ int clc_WP_sin(void) { static int index = 0; index++; if (index >= 40/*Device_blk.Str.PI_b3*/) index = 0; /* if (index > 20) LPC_GPIO0->FIOSET = (1<<26); else LPC_GPIO0->FIOCLR = (1<<26); */ DAC_Output(sin_func[index]); //output to DAC return (sin_func[index]); } // clc_WP_sin /****************************************************************************** ** Function name: WP_PhaseDetectorRate ** ** Descriptions: Integartion of output of the PD of the CPLC regulator for the technological output on the Rate command ** ** Parameters: Current PD magnitude, period of integration ** Returned value: Integrated magnitude of PD ** ******************************************************************************/ int WP_PhaseDetectorRate(int PhaseDetInput, int IntegrateTime) { static int SampleAndHoldOut = 0; static int WP_PhasDet_integr = 0;//, WP_PhasDetector = 0; if (IntegrateTime == DEVICE_SAMPLE_RATE_uks) { SampleAndHoldOut = (int)(WP_PhasDet_integr >> PLC_PHASE_DET_SHIFT); WP_PhasDet_integr = 0; } else { WP_PhasDet_integr += PhaseDetInput; } return (SampleAndHoldOut); } // WP_PhaseDetectorRate