/* * control_station_project.c * * Created on: 1 июн. 2020 г. * Author: Yura */ #include #include #include #include #include #include #include #include #include #include #include #include "control_station.h" #include "CAN_Setup.h" #include "global_time.h" #include "IQmathLib.h" #include "mathlib.h" #include "modbus_table_v2.h" #include "vector_control.h" #include "RS_Functions.h" #include "adc_tools.h" #include "RS_Function_terminal.h" #include "alg_simple_scalar.h" /*CONTROL_STATION_TERMINAL_RS232 CONTROL_STATION_TERMINAL_CAN, CONTROL_STATION_INGETEAM_PULT_RS485, CONTROL_STATION_MPU_SVU_CAN, CONTROL_STATION_MPU_KEY_CAN, CONTROL_STATION_MPU_SVU_RS485, CONTROL_STATION_MPU_KEY_RS485, CONTROL_STATION_ZADATCHIK_CAN, CONTROL_STATION_CMD_GO = 0,// cmd_go от поста пуск/стоп ШИМа CONTROL_STATION_CMD_SET_IZAD,// ток от поста CONTROL_STATION_CMD_SET_ROTOR,// обороты от поста CONTROL_STATION_CMD_CHARGE,// сбор схемы от поста CONTROL_STATION_CMD_UNCHARGE,// разбор схемы от поста CONTROL_STATION_CMD_CHECKBACK,// квитирование от поста CONTROL_STATION_CMD_TEST_LEDS */ #define DEC_ZAD_OBOROTS 1 #define INC_ZAD_OBOROTS 1 ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void detect_active_from_all_signals(void) { if (control_station.alive_control_station[CONTROL_STATION_TERMINAL_RS232]) { // control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ACTIVE_CONTROL] = control_station } } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// float plus_minus_oborots(int key_plus, int key_minus, float ff, int ufconst_vector, int flag) { static float ff_add=0, ff_dec=0; float ff_add1=0, ff_dec1=0; float ff_add2=0, ff_dec2=0; float ff_add3=0, ff_dec3=0; static int prev_key_plus=0, prev_key_minus=0, count_press2 = 0, level_d1 = 2; static int direct_zad=0, direct_cur=0, only_plus=0, only_minus=0; static unsigned int old_time_plus_minus=0, count_press = 0; if (flag==1) { count_press = 0; ff_dec = 0; ff_add = 0; prev_key_plus = key_plus; prev_key_minus = key_minus; return ff; } if (ff>0) { // if (key_minus || key_plus) only_plus = 1; only_minus = 0; } else if (ff<0) { // if (key_minus || key_plus) only_minus = 1; only_plus = 0; } else { if (key_minus==0 && key_plus==0) { only_plus = 0; only_minus = 0; } } // // // if (key_plus) // { // if (ff>0) // direct_zad = 1; // if (ff<0) // direct_zad = -1; // if (ff==0) // direct_zad = 0; // // } // if (key_minus) // { // if (ff>0) // direct_zad = -1; // if (ff<0) // direct_zad = 1; // if (ff==0) // direct_zad = 0; // } if (ufconst_vector==0) { ff_add1 = INC_ZAD_OBOROTS*10.0; ff_dec1 = DEC_ZAD_OBOROTS*10.0; ff_add2 = INC_ZAD_OBOROTS*30.0; ff_dec2 = DEC_ZAD_OBOROTS*30.0; ff_add3 = INC_ZAD_OBOROTS*60.0; ff_dec3 = DEC_ZAD_OBOROTS*60.0; } else { ff_add1 = INC_ZAD_OBOROTS; ff_dec1 = DEC_ZAD_OBOROTS; ff_add2 = INC_ZAD_OBOROTS*1.0; ff_dec2 = DEC_ZAD_OBOROTS*1.0; ff_add3 = INC_ZAD_OBOROTS*2.0; ff_dec3 = DEC_ZAD_OBOROTS*2.0; } if (detect_pause_milisec(250,&old_time_plus_minus)) { if (key_minus || key_plus) { if (count_press<300) count_press++; if (count_press2<10) count_press2++; } else { count_press = 0; count_press2 = 0; } if (count_press==1) { // ff_dec = 0; // ff_add = 0; ff_dec = ff_dec1; ff_add = ff_add1; level_d1 = 4; } if (count_press==6) { ff_dec = ff_dec1; ff_add = ff_add1; level_d1 = 2; } if (count_press==15) { ff_dec = ff_dec1; ff_add = ff_add1; level_d1 = 0; } // if (count_press==60) // { // ff_dec = ff_dec2; // ff_add = ff_add2; // level_d1 = 0; // } if (count_press==30) { ff_dec = ff_dec3; ff_add = ff_add3; } if (key_minus) { if ((count_press2>=level_d1) || (count_press==1)) { if (ff>ff_dec) { ff=ff-ff_dec; if (ff0) ff = 0; } else if (ff<=ff_dec && ff>0) ff=0; else if (ff<0 && only_plus==0) ff=ff-ff_add; else if (ff==0 && only_plus==0) ff=ff-DEAD_ZONE_ZADANIE_OBOROTS_ROTOR; count_press2 = 0; } } else if (key_plus) { if ((count_press2>=level_d1) || (count_press==1)) { if (ff==0 && only_minus==0) ff=ff+DEAD_ZONE_ZADANIE_OBOROTS_ROTOR; else if (ff>=0 && only_minus==0) ff=ff+ff_add; else if (ff>=-ff_dec && ff<0) ff=0; else if (ff<-ff_dec) { ff=ff+ff_dec; if (ff>-DEAD_ZONE_ZADANIE_OBOROTS_ROTOR && ff<0) ff = 0; } count_press2 = 0; } } } if (ufconst_vector==0) ff = my_satur_float(ff,fast_round(MAX_ZADANIE_F*100.0),fast_round(-MAX_ZADANIE_F*100.0), 0); else ff = my_satur_float(ff, MAX_ZADANIE_OBOROTS_ROTOR, MIN_ZADANIE_OBOROTS_ROTOR, 0); prev_key_plus = key_plus; prev_key_minus = key_minus; return ff; } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_another_bs(int cc) { int i;//, pos_numbercmd; static int prev_checkback = 0; static int flag_wait_revers_go = 0; _iq _iq_ff; static unsigned int prev_charge=0, prev_uncharge=0, key_local_charge=0, key_local_uncharge=0; static unsigned int old_time_pult_ing = 0; float ff=0, ff_add=0, ff_dec=0; int key_plus = 0, key_minus = 0; if (edrk.ms.err_signals.alive_can_to_another_bs==0) { // // edrk.zadanie_from_another_bs.int_fzad = Unites[ANOTHER_BSU1_CAN_DEVICE][3]; // edrk.zadanie_from_another_bs.int_kzad = Unites[ANOTHER_BSU1_CAN_DEVICE][4]; // edrk.zadanie_from_another_bs.int_Izad = Unites[ANOTHER_BSU1_CAN_DEVICE][5]; // edrk.zadanie_from_another_bs.int_oborots_zad = Unites[ANOTHER_BSU1_CAN_DEVICE][6]; // edrk.zadanie_from_another_bs.int_power_zad = Unites[ANOTHER_BSU1_CAN_DEVICE][7]; // // // edrk.zadanie_from_another_bs.iq_fzad = _IQ15toIQ(edrk.zadanie_from_another_bs.int_fzad); // edrk.zadanie_from_another_bs.iq_kzad = _IQ15toIQ(edrk.zadanie_from_another_bs.int_kzad); // edrk.zadanie_from_another_bs.iq_Izad = _IQ15toIQ(edrk.zadanie_from_another_bs.int_Izad); // edrk.zadanie_from_another_bs.oborots_zad = edrk.zadanie_from_another_bs.int_oborots_zad; // edrk.zadanie_from_another_bs.iq_power_zad = _IQ15toIQ(edrk.zadanie_from_another_bs.int_power_zad); } else { } if (control_station.alive_control_station[cc]) { } else { for (i=0;i 0 && Unites[ANOTHER_BSU1_CAN_DEVICE][12] < 600) { vect_control.iqId_min = _IQ((float)Unites[ANOTHER_BSU1_CAN_DEVICE][12] / NORMA_ACP); } /* control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL] = control_station.active_control_station[CONTROL_STATION_VPU_CAN]; // scalar, vector, ufconst control_station.array_cmd[cc][CONTROL_STATION_CMD_UFCONST_VECTOR] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_UFCONST_VECTOR]; control_station.array_cmd[cc][CONTROL_STATION_CMD_SCALAR_FOC] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SCALAR_FOC]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ROTOR_POWER] = 0; // аналоговые // if if ((detect_pause_milisec(100,&old_time_pult_ing)) && control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]) { // control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.raw_array_data[cc][4].all; ff = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]; key_plus = edrk.from_vpu.bits.PLUS; key_minus = edrk.from_vpu.bits.MINUS; ff = plus_minus_oborots(key_plus, key_minus, ff, control_station.array_cmd[cc][CONTROL_STATION_CMD_UFCONST_VECTOR]); control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR] = ff; } // цифровые // pos_numbercmd = 15; // с какого элемента массива идут команды, они после аналоговых данных control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK] = edrk.from_vpu.bits.KVITIR; // заряд, разряд key_local_charge = 0;//edrk.from_shema.bits.SBOR_SHEMA; key_local_uncharge = 0;//edrk.from_shema.bits.RAZBOR_SHEMA; if (key_local_charge && prev_charge==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; prev_charge = key_local_charge; if (key_local_uncharge && prev_uncharge==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; prev_uncharge = key_local_uncharge; /////////////////////////////////////////// // эти берем с терминалки control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_IZAD] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SET_IZAD]; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_KM] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SET_KM]; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_U_ZARYAD] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SET_U_ZARYAD]; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_K_U_DISBALANCE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SET_K_U_DISBALANCE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_K_PLUS_U_DISBALANCE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_SET_K_PLUS_U_DISBALANCE]; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 1; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_GO]; // // control_station.array_cmd[cc][CONTROL_STATION_CMD_TEST_LEDS] = 0; // // prev_checkback = control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // копируем из rs232 control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_QTV]; // 0 - auto on - rand pump // 1 - auto on 1 pump // 2 - auto on 2 pump // 3 - manual on 1 pump // 4 - manual on 2 pump // берем сигнал управления насосов от пульта control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MODE_PUMP]; if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; */ } ///////////////////////////////////////////////////////////// ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_pult_vpu(int cc) { int i;//, pos_numbercmd; static int prev_checkback = 0, prev_key_oborots = 0; static int flag_wait_revers_go = 0; _iq _iq_ff; static unsigned int prev_charge=0, prev_uncharge=0, key_local_charge=0, key_local_uncharge=0; static unsigned int old_time_pult_ing = 0, old_time_pult_ing2 = 0; float ff=0, ff_add=0, ff_dec=0; int key_plus = 0, key_minus = 0; if (control_station.alive_control_station[cc]) { } else { for (i=0;i=0) control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; else control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = -control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; // цифровые // pos_numbercmd = 15; // с какого элемента массива идут команды, они после аналоговых данных control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK] = edrk.from_vpu.bits.KVITIR; // заряд, разряд key_local_charge = 0;//edrk.from_shema.bits.SBOR_SHEMA; key_local_uncharge = 0;//edrk.from_shema.bits.RAZBOR_SHEMA; if (key_local_charge && prev_charge==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; prev_charge = key_local_charge; if (key_local_uncharge) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; prev_uncharge = key_local_uncharge; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 1; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // // control_station.array_cmd[cc][CONTROL_STATION_CMD_TEST_LEDS] = 0; // // prev_checkback = control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // копируем из rs232 if (control_station.alive_control_station[CONTROL_STATION_TERMINAL_RS232]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_STOP_LOGS] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_STOP_LOGS]; } else if (control_station.alive_control_station[CONTROL_STATION_INGETEAM_PULT_RS485]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; edrk.Status_Ready.bits.ImitationReady2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][181].all; edrk.Obmotka1 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][194].all; edrk.Obmotka2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][195].all; edrk.disable_alg_u_disbalance = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][193].all; edrk.Run_Rascepitel_from_RS = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][182].all; edrk.stop_logs_rs232 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][183].all; edrk.stop_slow_log = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][184].all; edrk.disable_limit_power_from_svu = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][185].all; edrk.disable_uom = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][186].all; } // 0 - auto on - rand pump // 1 - auto on 1 pump // 2 - auto on 2 pump // 3 - manual on 1 pump // 4 - manual on 2 pump // берем сигнал управления насосов от пульта control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MODE_PUMP]; if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; } ///////////////////////////////////////////////////////////// ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_pult_zadat4ik(int cc) { int i;//, pos_numbercmd; static int prev_checkback = 0, prev_key_oborots = 0; static int flag_wait_revers_go = 0; float ff=0, ff_add=0, ff_dec=0; int key_plus = 0, key_minus = 0; _iq _iq_ff; static unsigned int prev_charge=0, prev_uncharge=0, key_local_charge=0, key_local_uncharge=0; static unsigned int old_time_pult_ing = 0, old_time_pult_ing2 = 0; if (control_station.alive_control_station[cc]) { } else { for (i=0;i=0) control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; else control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = -control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; // цифровые // pos_numbercmd = 15; // с какого элемента массива идут команды, они после аналоговых данных control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK] = edrk.from_zadat4ik.bits.KVITIR; // заряд, разряд key_local_charge = edrk.from_shema_filter.bits.SBOR_SHEMA; key_local_uncharge = edrk.from_shema_filter.bits.RAZBOR_SHEMA; if (key_local_uncharge && key_local_charge) { key_local_uncharge = 0; key_local_charge = 0; //edrk.errors.e1.bits.BOTH_KEYS_CHARGE_DISCHARGE |=1; } if (key_local_charge && prev_charge==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; prev_charge = key_local_charge; if (key_local_uncharge) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; prev_uncharge = key_local_uncharge; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 1; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // // control_station.array_cmd[cc][CONTROL_STATION_CMD_TEST_LEDS] = 0; // // prev_checkback = control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // копируем из rs232 if (control_station.alive_control_station[CONTROL_STATION_TERMINAL_RS232]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; } else if (control_station.alive_control_station[CONTROL_STATION_INGETEAM_PULT_RS485]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; edrk.Status_Ready.bits.ImitationReady2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][181].all; edrk.Obmotka1 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][194].all; edrk.Obmotka2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][195].all; edrk.disable_alg_u_disbalance = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][193].all; edrk.Run_Rascepitel_from_RS = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][182].all; edrk.stop_logs_rs232 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][183].all; edrk.stop_slow_log = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][184].all; edrk.disable_limit_power_from_svu = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][185].all; edrk.disable_uom = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][186].all; } // 0 - auto on - rand pump // 1 - auto on 1 pump // 2 - auto on 2 pump // 3 - manual on 1 pump // 4 - manual on 2 pump // берем сигнал управления насосов от пульта control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MODE_PUMP]; if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_pult_ingeteam(int cc) { int i, zad_power; //pos_numbercmd static int prev_checkback = 0; static int flag_wait_revers_go = 0; float ff=0, ff_add=0, ff_dec=0; int key_plus = 0, key_minus = 0; _iq _iq_ff=0; static unsigned int prev_key_local_charge_key=0, prev_key_local_uncharge_key=0, key_local_charge_key=0, key_local_uncharge_key=0; static unsigned int prev_key_local_charge_display=0, prev_key_local_uncharge_display=0, key_local_charge_display=0, key_local_uncharge_display=0; static unsigned int prev_charge=0, prev_uncharge=0, key_local_charge=0, key_local_uncharge=0; static unsigned int old_time_pult_ing = 0, old_time_pult_ing2 = 0; static unsigned int prev_key_local_charge_uncharge_display=0, key_local_charge_uncharge_display=0; if (control_station.alive_control_station[cc]) { } else { for (i=0;i=0) control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; else control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = -control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; } } // цифровые // pos_numbercmd = 15; // с какого элемента массива идут команды, они после аналоговых данных control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK] = control_station.raw_array_data[cc][1].all; // заряд, разряд по кнопке key_local_charge_key = edrk.from_ing2.bits.KEY_SBOR; key_local_uncharge_key = edrk.from_ing2.bits.KEY_RAZBOR; // заряд, разряд от дисплея key_local_charge_uncharge_display = control_station.raw_array_data[cc][2].all; prev_key_local_charge_key = key_local_charge_key; prev_key_local_uncharge_key = key_local_uncharge_key; if (prev_key_local_charge_uncharge_display != key_local_charge_uncharge_display) { if (key_local_charge_uncharge_display==1) { key_local_charge_display = 1; key_local_uncharge_display = 0; } else { key_local_charge_display = 0; key_local_uncharge_display =1; } } else { key_local_charge_display = 0; key_local_uncharge_display = 0; } prev_key_local_charge_uncharge_display = key_local_charge_uncharge_display; prev_key_local_charge_display = key_local_charge_display; prev_key_local_uncharge_display = key_local_uncharge_display; key_local_charge = key_local_charge_key || key_local_charge_display; key_local_uncharge = key_local_uncharge_key || key_local_uncharge_display; if (key_local_uncharge_key && key_local_charge_key) { key_local_uncharge_key = 0; key_local_charge_key = 0; // edrk.errors.e1.bits.BOTH_KEYS_CHARGE_DISCHARGE |=1; } if (edrk.Status_Ready.bits.ImitationReady2==0) // объехали сбор с пульта, т.к. не нужен при имитации { if (key_local_charge && prev_charge==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; if (key_local_uncharge) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } prev_charge = key_local_charge; prev_uncharge = key_local_uncharge; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 1; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // // // control_station.array_cmd[cc][CONTROL_STATION_CMD_TEST_LEDS] = 0; // // prev_checkback = control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // копируем из rs232 if (control_station.alive_control_station[CONTROL_STATION_TERMINAL_RS232]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_PUMP] || control_station.raw_array_data[cc][188].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] || control_station.raw_array_data[cc][191].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_QTV] || control_station.raw_array_data[cc][189].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_UMP] || control_station.raw_array_data[cc][190].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_MANUAL_DISCHARGE] || control_station.raw_array_data[cc][180].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_GO] || !control_station.raw_array_data[cc][192].all; } else { edrk.Status_Ready.bits.ImitationReady2 = control_station.raw_array_data[cc][181].all; edrk.Run_Rascepitel_from_RS = control_station.raw_array_data[cc][182].all; edrk.stop_logs_rs232 = control_station.raw_array_data[cc][183].all; edrk.stop_slow_log = control_station.raw_array_data[cc][184].all; edrk.disable_limit_power_from_svu = control_station.raw_array_data[cc][185].all; edrk.disable_uom = control_station.raw_array_data[cc][186].all; edrk.Obmotka1 = control_station.raw_array_data[cc][194].all; edrk.Obmotka2 = control_station.raw_array_data[cc][195].all; edrk.disable_alg_u_disbalance = control_station.raw_array_data[cc][193].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.raw_array_data[cc][188].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.raw_array_data[cc][189].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.raw_array_data[cc][190].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.raw_array_data[cc][191].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.raw_array_data[cc][180].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = !control_station.raw_array_data[cc][192].all; } //control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.raw_array_data[cc][188].all; // control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.raw_array_data[cc][189].all; //control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.raw_array_data[cc][190].all; //control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.raw_array_data[cc][191].all; // control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.raw_array_data[cc][180].all; // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = !control_station.raw_array_data[cc][192].all; // 0 - auto on - rand pump // 1 - auto on 1 pump // 2 - auto on 2 pump // 3 - manual on 1 pump // 4 - manual on 2 pump if (control_station.raw_array_data[cc][9].all<=2) //Вкл Насос_авто(0)_ручной(1) { if (control_station.raw_array_data[cc][9].all==0) // Авто выбор Насоса(0) 1_2(1) control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = 0; if (control_station.raw_array_data[cc][9].all==1) //Ручной выбор насоса_1 control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = 1; if (control_station.raw_array_data[cc][9].all==2) //Ручной выбор насоса_2 control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = 2; } else { if (control_station.raw_array_data[cc][9].all==3) //Ручной выбор насоса_1_2 control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = 3; if (control_station.raw_array_data[cc][9].all==4) //Ручной выбор насоса_1_2 control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = 4; } if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_MPU_SVU(int cc) { int i, zad_power, limit_power; _iq _iq_ff; static unsigned int old_time_MPU_SVU = 0; static int prev_checkback_3 = 0; static int flag_wait_revers_go_3 = 0; static unsigned int prev_charge_3 = 0, prev_uncharge_3 = 0, cmd_local_charge_3 = 0, cmd_local_uncharge_3 = 0; static unsigned int old_time_MPU_SVU_3 = 0; static int prev_checkback_4 = 0; static int flag_wait_revers_go_4 = 0; static unsigned int prev_charge_4 = 0, prev_uncharge_4 = 0, cmd_local_charge_4 = 0, cmd_local_uncharge_4 = 0; static unsigned int old_time_MPU_SVU_4 = 0; if (control_station.alive_control_station[cc]) { } else { for (i=0;i=0) control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; else control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = -control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; } } //Квитирование control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK] = control_station.raw_array_data[cc][0].all; if (cc==CONTROL_STATION_MPU_SVU_CAN) { // заряд, разряд if (edrk.flag_second_PCH == 0) { cmd_local_charge_3 = control_station.raw_array_data[cc][6].all; cmd_local_uncharge_3 = control_station.raw_array_data[cc][9].all; } else { cmd_local_charge_3 = control_station.raw_array_data[cc][7].all;//modbus_table_can_in[129].all; //control_station.raw_array_data[cc][7].all; cmd_local_uncharge_3 = control_station.raw_array_data[cc][10].all; } if (cmd_local_charge_3 && cmd_local_uncharge_3) { cmd_local_charge_3 = 0; cmd_local_uncharge_3 = 0; // edrk.errors.e1.bits.BOTH_KEYS_CHARGE_DISCHARGE |=1; } if (cmd_local_charge_3 && prev_charge_3==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; prev_charge_3 = cmd_local_charge_3; if (cmd_local_uncharge_3) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; prev_uncharge_3 = cmd_local_uncharge_3; } if (cc==CONTROL_STATION_MPU_KEY_CAN) { // заряд, разряд if (edrk.flag_second_PCH == 0) { cmd_local_charge_4 = control_station.raw_array_data[cc][6].all; cmd_local_uncharge_4 = control_station.raw_array_data[cc][9].all; } else { cmd_local_charge_4 = control_station.raw_array_data[cc][7].all;//modbus_table_can_in[129].all; //control_station.raw_array_data[cc][7].all; cmd_local_uncharge_4 = control_station.raw_array_data[cc][10].all; } if (cmd_local_charge_4 && cmd_local_uncharge_4) { cmd_local_charge_4 = 0; cmd_local_uncharge_4 = 0; // edrk.errors.e1.bits.BOTH_KEYS_CHARGE_DISCHARGE |=1; } if (cmd_local_charge_4 && prev_charge_4==0) { control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; prev_charge_4 = cmd_local_charge_4; if (cmd_local_uncharge_4) { control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_CHARGE] = 0; } else control_station.array_cmd[cc][CONTROL_STATION_CMD_UNCHARGE] = 0; prev_uncharge_4 = cmd_local_uncharge_4; } control_station.array_cmd[cc][CONTROL_STATION_CMD_BLOCK_BS] = control_station.raw_array_data[cc][4].all; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 1; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // // // control_station.array_cmd[cc][CONTROL_STATION_CMD_TEST_LEDS] = 0; // // prev_checkback = control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // копируем из rs232 if (control_station.alive_control_station[CONTROL_STATION_TERMINAL_RS232]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; } else if (control_station.alive_control_station[CONTROL_STATION_INGETEAM_PULT_RS485]) { control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_GO]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_PUMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_ENABLE_ON_CHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_ENABLE_ON_CHARGE]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_QTV] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_QTV]; control_station.array_cmd[cc][CONTROL_STATION_CMD_DISABLE_ON_UMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_DISABLE_ON_UMP]; control_station.array_cmd[cc][CONTROL_STATION_CMD_MANUAL_DISCHARGE] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MANUAL_DISCHARGE]; edrk.Status_Ready.bits.ImitationReady2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][181].all; edrk.Obmotka1 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][194].all; edrk.Obmotka2 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][195].all; edrk.disable_alg_u_disbalance = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][193].all; edrk.Run_Rascepitel_from_RS = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][182].all; edrk.stop_logs_rs232 = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][183].all; edrk.stop_slow_log = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][184].all; edrk.disable_limit_power_from_svu = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][185].all; edrk.disable_uom = control_station.raw_array_data[CONTROL_STATION_INGETEAM_PULT_RS485][186].all; } // 0 - auto on - rand pump // 1 - auto on 1 pump // 2 - auto on 2 pump // 3 - manual on 1 pump // 4 - manual on 2 pump //Автовыбор насоса control_station.array_cmd[cc][CONTROL_STATION_CMD_MODE_PUMP] = control_station.array_cmd[CONTROL_STATION_INGETEAM_PULT_RS485][CONTROL_STATION_CMD_MODE_PUMP]; edrk.breaker_on = control_station.raw_array_data[cc][17].all; edrk.break_tempers[0] = control_station.raw_array_data[cc][18].all; edrk.break_tempers[1] = control_station.raw_array_data[cc][19].all; edrk.break_tempers[2] = control_station.raw_array_data[cc][20].all; edrk.break_tempers[3] = control_station.raw_array_data[cc][21].all; if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; } ///////////////////////////////////////////////////////////// ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_one_control_station_terminal_rs232(int cc) { static int pos_numbercmd = (sizeof(CMD_ANALOG_DATA_STRUCT) >> 1); int i, fint; static int prev_checkback = 0, lock_ImitationReady2 = 0; static int flag_wait_revers_go = 0; static unsigned int prev_charge=0, prev_uncharge=0, key_local_charge=0, key_local_uncharge=0; float ff; _iq _iq_ff; int zad_power=0; if (control_station.alive_control_station[cc]) { } else { for (i=0;i=0) control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; else control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = -control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_LIMIT_POWER]; } //control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR] = (int)control_station.raw_array_data[cc][0].all; //control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER] = my_satur_int(control_station.raw_array_data[cc][2].all, MAX_ZADANIE_POWER, MIN_ZADANIE_POWER); control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_KM] = control_station.raw_array_data[cc][1].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_IZAD] = my_satur_int(control_station.raw_array_data[cc][3].all, MAX_ZADANIE_I_M, 0, 0); control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_U_ZARYAD] = control_station.raw_array_data[cc][4].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_K_U_DISBALANCE] = control_station.raw_array_data[cc][5].all; control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_K_PLUS_U_DISBALANCE] = control_station.raw_array_data[cc][6].all; if (control_station.raw_array_data[cc][8].all > 0 && control_station.raw_array_data[cc][8].all <= 600 && edrk.MasterSlave == MODE_MASTER) { vect_control.iqId_min = _IQ((float)control_station.raw_array_data[cc][8].all / NORMA_ACP); } fint = (int)control_station.raw_array_data[cc][9].all; if (fint>=-360 && fint<=360 && edrk.MasterSlave == MODE_MASTER) { vect_control.add_tetta = _IQ(fint / 180.0 * PI); } else vect_control.add_tetta = 0; fint = (int)control_station.raw_array_data[cc][10].all; if (fint>=0) { edrk.t_slow_log = fint; } else edrk.t_slow_log = 0; fint = (int)control_station.raw_array_data[cc][11].all; if (fint) { simple_scalar1.add_bpsi = _IQ(fint/1000.0/NORMA_FROTOR);//_IQ(0.05/NORMA_FROTOR); } else simple_scalar1.add_bpsi = 0; fint = (int)control_station.raw_array_data[cc][12].all; if (fint) { simple_scalar1.add_power_limit = _IQ(fint*1000.0/(NORMA_MZZ*NORMA_MZZ));//_IQ(0.05/NORMA_FROTOR); } else simple_scalar1.add_power_limit = 0; fint = (int)control_station.raw_array_data[cc][13].all; if (fint) { simple_scalar1.sdvig_power_limit = _IQ(fint*1000.0/(NORMA_MZZ*NORMA_MZZ));//_IQ(0.05/NORMA_FROTOR); } else simple_scalar1.sdvig_power_limit = 0; //#if (_FLOOR6) fint = (int)control_station.raw_array_data[cc][14].all; if (fint>=0 && fint<=3200) { analog.iqU_1_imit = _IQ(fint/NORMA_ACP); } else analog.iqU_1_imit = 0; //#else // analog.iqU_1_imit = 0; //#endif prev_checkback = control_station.array_cmd[cc][CONTROL_STATION_CMD_CHECKBACK];//control_station.raw_array_data[cc][pos_numbercmd].bits.bit1; // edrk.KvitirRS = 1; control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.raw_array_data[cc][pos_numbercmd].bits.bit5; // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ROTOR_POWER]==0) // { // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.raw_array_data[cc][pos_numbercmd].bits.bit5; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // } // else // { // if (control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_POWER]!=0) // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = control_station.raw_array_data[cc][pos_numbercmd].bits.bit5; // else // control_station.array_cmd[cc][CONTROL_STATION_CMD_GO] = 0; // } /* edrk.from_rs.bits.ACTIVE = control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]; if (edrk.from_rs.bits.ACTIVE==0) return; edrk.from_can.bits.ACTIVE = 0; */ if (control_station.array_cmd[cc][CONTROL_STATION_CMD_ACTIVE_CONTROL]==0) return; // мы в анализе CAN данных и включено управления с RS232 if (control_station.array_cmd[CONTROL_STATION_TERMINAL_RS232][CONTROL_STATION_CMD_ACTIVE_CONTROL] && cc==CONTROL_STATION_TERMINAL_CAN) return; // edrk.DirectOUT = control_station.raw_array_data[cc][pos_numbercmd].bits.bit7; // edrk.DirectNagrevOff = control_station.raw_array_data[cc][pos_numbercmd].bits.bit8; // edrk.DirectBlockKeyOff = control_station.raw_array_data[cc][pos_numbercmd].bits.bit9; //// edrk.DirectPumpON = control_station.raw_array_data[cc][pos_numbercmd].bits.bit10; // edrk.DirectZaryadOn = control_station.raw_array_data[cc][pos_numbercmd].bits.bit11; // edrk.SetSpeed = control_station.raw_array_data[cc][pos_numbercmd].bits.bit14; //////////////////////////// ///////////////////////// } ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// void parse_data_from_master_to_alg(void) { if (edrk.MasterSlave==MODE_SLAVE) { control_station.active_array_cmd[CONTROL_STATION_CMD_SET_ROTOR] = control_station.array_cmd[CONTROL_STATION_ANOTHER_BS][CONTROL_STATION_CMD_SET_ROTOR]; control_station.active_array_cmd[CONTROL_STATION_CMD_SET_KM] = control_station.array_cmd[CONTROL_STATION_ANOTHER_BS][CONTROL_STATION_CMD_SET_KM]; control_station.active_array_cmd[CONTROL_STATION_CMD_SET_IZAD] = control_station.array_cmd[CONTROL_STATION_ANOTHER_BS][CONTROL_STATION_CMD_SET_IZAD]; control_station.active_array_cmd[CONTROL_STATION_CMD_SET_POWER] = control_station.array_cmd[CONTROL_STATION_ANOTHER_BS][CONTROL_STATION_CMD_SET_POWER]; } } ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// ////////////////////////////////////////////////////// void parse_analog_data_from_active_control_station_to_alg(void) { float ff, ff1; _iq _iq_ff; int i; // edrk.disable_interrupt_sync = control_station.active_array_cmd[CONTROL_STATION_CMD_DISABLE_INTERRUPT_SYNC]; // edrk.disable_interrupt_timer2 = control_station.active_array_cmd[CONTROL_STATION_CMD_DISABLE_INTERRUPT_TIMER2]; edrk.NoDetectUZeroDischarge = control_station.active_array_cmd[CONTROL_STATION_CMD_DISABLE_ON_QTV]; // if (current_active_control==CONTROL_STATION_TERMINAL_RS232) edrk.StartGEDfromControl = control_station.active_array_cmd[CONTROL_STATION_CMD_GO]; ////////////////// if (control_station.active_array_cmd[CONTROL_STATION_CMD_UFCONST_VECTOR]==0) edrk.Mode_ScalarVectorUFConst = ALG_MODE_UF_CONST; else if (control_station.active_array_cmd[CONTROL_STATION_CMD_SCALAR_FOC]==0) { if (control_station.active_array_cmd[CONTROL_STATION_CMD_ROTOR_POWER]==0) edrk.Mode_ScalarVectorUFConst = ALG_MODE_SCALAR_OBOROTS; else edrk.Mode_ScalarVectorUFConst = ALG_MODE_SCALAR_POWER; } else { if (control_station.active_array_cmd[CONTROL_STATION_CMD_ROTOR_POWER]==0) edrk.Mode_ScalarVectorUFConst = ALG_MODE_FOC_OBOROTS; else edrk.Mode_ScalarVectorUFConst = ALG_MODE_FOC_POWER; } ////////////////////////////////////////////////////// // edrk.W_from_RS = control_station.array_cmd[cc][CONTROL_STATION_CMD_SET_ROTOR]; //DataAnalog1; // ff = control_station.active_array_cmd[CONTROL_STATION_CMD_SET_I_VOZBUD];//0;//DataAnalog4; // edrk.I_zad_vozb_add_from_RS = my_satur_float(ff,MAX_ZADANIE_I_VOZBUD,0); ff = control_station.active_array_cmd[CONTROL_STATION_CMD_SET_U_ZARYAD]; edrk.zadanie.ZadanieU_Charge = my_satur_float(ff,MAX_ZADANIE_U_CHARGE,0,0); edrk.zadanie.iq_ZadanieU_Charge = _IQ(edrk.zadanie.ZadanieU_Charge/NORMA_ACP); if (edrk.Status_Ready.bits.ready_final==0) { // если схема не собрана, обнуляем задания во всех постах for (i=0;idigit_data.Byte01.bit_data.bit0 && flag_wait_revers_go) edrk.StartGEDRS = 0; if (pcommand->digit_data.Byte01.bit_data.bit0==0) edrk.StartGEDRS = 0; if (pcommand->digit_data.Byte01.bit_data.bit0==0 && flag_wait_revers_go) flag_wait_revers_go = 0; if (pcommand->digit_data.Byte01.bit_data.bit0==1 && flag_wait_revers_go==0) edrk.StartGEDRS = 1; // edrk.StartGEDRS = pcommand->digit_data.Byte01.bit_data.bit0; */ // end StartGED //////////////// // edrk.from_rs.bits.RAZBOR_SHEMA = pcommand->digit_data.Byte01.bit_data.bit5; // SBOR SHEMA /* if (edrk.summ_errors) { flag_wait_revers_sbor = 1; } if (flag_wait_revers_sbor==1) edrk.from_can.bits.SBOR_SHEMA = 0; if (pcommand->digit_data.Byte01.bit_data.bit4 && flag_wait_revers_sbor) edrk.from_can.bits.SBOR_SHEMA = 0; if (pcommand->digit_data.Byte01.bit_data.bit4==0) edrk.from_can.bits.SBOR_SHEMA = 0; if (pcommand->digit_data.Byte01.bit_data.bit4==0 && flag_wait_revers_sbor) flag_wait_revers_sbor = 0; if (pcommand->digit_data.Byte01.bit_data.bit4==1 && flag_wait_revers_sbor==0) edrk.from_can.bits.SBOR_SHEMA = pcommand->digit_data.Byte01.bit_data.bit4; prev_byte01_bit4 = pcommand->digit_data.Byte01.bit_data.bit4; */ // end SBOR SHEMA // if (edrk.from_rs.bits.RAZBOR_SHEMA) // edrk.from_rs.bits.SBOR_SHEMA = 0; //edrk.SborRS = pcommand->digit_data.Byte01.bit_data.bit4; // edrk.to_shema.bits.QTV_ON = pcommand->digit_data.Byte02.bit_data.bit3; // edrk.RemouteFromRS = pcommand->digit_data.Byte01.bit_data.bit3; // edrk.VozbudOnOffFromRS = pcommand->digit_data.Byte01.bit_data.bit1; // edrk.enable_set_vozbud = pcommand->digit_data.Byte01.bit_data.bit1; // edrk.SborRS = pcommand->digit_data.Byte01.bit_data.bit2; // edrk.RazborRS = pcommand->digit_data.Byte01.bit_data.bit3; // edrk.DirectOUT = pcommand->digit_data.Byte01.bit_data.bit4; // edrk.StartGED = pcommand->digit_data.Byte01.bit_data.bit6; // f.flag_distance = pcommand->digit_data.Byte01.bit_data.bit6; // f.Set_power = pcommand->digit_data.Byte01.bit_data.bit7; // f.Down50 = pcommand->digit_data.Byte02.bit_data.bit2; // f.Up50 = pcommand->digit_data.Byte02.bit_data.bit3; // f.Ciclelog = pcommand->digit_data.Byte02.bit_data.bit4; // if (SPEED_SELECT_ZADAT==1) // f.Provorot = pcommand->digit_data.Byte02.bit_data.bit5; } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void parse_parameters_from_all_control_station(void) { parse_parameters_from_one_control_station_terminal_rs232(CONTROL_STATION_TERMINAL_RS232); parse_parameters_from_one_control_station_terminal_rs232(CONTROL_STATION_TERMINAL_CAN); load_parameters_from_can_control_station_to_rs232(); if (edrk.get_new_data_from_hmi==1) // данные пришли? { func_unpack_answer_from_Ingeteam(CONTROL_STATION_INGETEAM_PULT_RS485); parse_parameters_from_one_control_station_pult_ingeteam(CONTROL_STATION_INGETEAM_PULT_RS485); edrk.get_new_data_from_hmi = 2; // данные распарсены и уложены в modbus } parse_parameters_from_one_control_station_pult_zadat4ik(CONTROL_STATION_ZADATCHIK_CAN); parse_parameters_from_one_control_station_pult_vpu(CONTROL_STATION_VPU_CAN); parse_parameters_from_one_control_station_another_bs(CONTROL_STATION_ANOTHER_BS); // unpack_answer_from_MPU_SVU_CAN(CONTROL_STATION_MPU_SVU_CAN); unpack_answer_from_MPU_SVU_CAN(CONTROL_STATION_MPU_KEY_CAN); //4 unpack_answer_from_MPU_SVU_CAN(CONTROL_STATION_MPU_SVU_CAN); //3 // unpack_answer_from_MPU_SVU_RS(CONTROL_STATION_MPU_SVU_RS485); parse_parameters_from_one_control_station_MPU_SVU(CONTROL_STATION_MPU_SVU_CAN); //3 parse_parameters_from_one_control_station_MPU_SVU(CONTROL_STATION_MPU_KEY_CAN); //4 // parse_parameters_from_one_control_station_MPU_SVU(CONTROL_STATION_MPU_SVU_RS485); } ///////////////////////////////////////////////////////////// // ///////////////////////////////////////////////////////////// void load_parameters_from_active_control_station(int current_control) { int i; if (current_control>=CONTROL_STATION_LAST || current_control<0 ) { // что-то не то! пост не определен! for (i=0;i