You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
271 lines
9.2 KiB
C++
271 lines
9.2 KiB
C++
/*
|
|
* SystemControl.h
|
|
*
|
|
* Author: Aleksey Gerasimenko
|
|
* gerasimenko.aleksey.n@gmail.com
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include <math.h>
|
|
#include <stdint.h>
|
|
|
|
#include "framework.h"
|
|
#include "DSP2833x_Device.h" // DSP2833x Headerfile Include File
|
|
#include "DSP2833x_Examples.h"
|
|
|
|
#include "FRAM/FRAMheaders.h"
|
|
#include "SYSCTRL/HeadersFLTSYSLIB.h"
|
|
#include "SYSCTRL/HeadersMODBUSRTU.h"
|
|
#include "SYSCTRL/SystemConfigurator.h"
|
|
#include "SYSCTRL/SystemEnvironment.h"
|
|
#include "SYSCTRL/VectorSpinner.h"
|
|
#include "SYSCTRL/TypeControl.h"
|
|
|
|
#include "SYSCTRL/MaxDetection.h" // for debug!!!
|
|
|
|
|
|
#ifndef TRAPSWRST
|
|
#define TRAPSWRST __asm(" TRAP #20")
|
|
#endif
|
|
|
|
|
|
|
|
#ifndef SYSCTRL_SYSTEMCONTROL_H_
|
|
#define SYSCTRL_SYSTEMCONTROL_H_
|
|
|
|
namespace SYSCTRL
|
|
{
|
|
|
|
|
|
|
|
class SystemControl
|
|
{
|
|
public:
|
|
enum mode_t {UNDEFINED, CONFIGURATE, OPERATIONAL};
|
|
private:
|
|
mode_t m_mode;
|
|
SYSCTRL::AlgorithmContext::algorithm_t m_algorithm_executed;
|
|
bool turnQ1On;
|
|
private:
|
|
// for debug!!!
|
|
MaxDetection IcellMax;
|
|
MaxDetection IloadMax;
|
|
MaxDetection IinputMax;
|
|
//Decompose Signals
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_input_a;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_input_b;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_input_c;
|
|
//
|
|
#if TYPEVOLTAGEDECOMPOSE == TYPEVOLTAGEDECOMPOSE_DIFFICULT
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_load_a;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_load_b;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_voltage_load_c;
|
|
#endif
|
|
#if TYPEVOLTAGEDECOMPOSE == TYPEVOLTAGEDECOMPOSE_SIMPLE
|
|
SYSCTRL::SignalDecomposeFI m_decompose_voltage_load_a;
|
|
SYSCTRL::SignalDecomposeFI m_decompose_voltage_load_b;
|
|
SYSCTRL::SignalDecomposeFI m_decompose_voltage_load_c;
|
|
#endif
|
|
//
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_load_a;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_load_b;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_load_c;
|
|
//
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_bypass_a;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_bypass_b;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_bypass_c;
|
|
//
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_cell_a;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_cell_b;
|
|
SYSCTRL::SignalDecomposeFIV m_decompose_current_cell_c;
|
|
//
|
|
private:
|
|
//
|
|
// RMS Filters
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_input_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_input_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_input_c;
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_cell_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_cell_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_cell_c;
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_load_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_load_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_load_c;
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_input_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_input_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_input_c;
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_load_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_load_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_voltage_load_c;
|
|
//
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_bypass_a;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_bypass_b;
|
|
FLTSYSLIB::RMSF4O m_rms_filter_current_bypass_c;
|
|
//
|
|
private:
|
|
//
|
|
// Zero Drift Analog Signals
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_input_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_input_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_input_c;
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_input_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_input_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_input_c;
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_cell_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_cell_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_cell_c;
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_load_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_load_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_voltage_load_c;
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_load_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_load_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_load_c;
|
|
//
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_bypass_a;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_bypass_b;
|
|
FLTSYSLIB::FilterForth m_zero_filter_current_bypass_c;
|
|
//
|
|
private:
|
|
//Cell DC Voltage Filter
|
|
FLTSYSLIB::FilterForth m_cell_dc_voltage_a_filter;
|
|
FLTSYSLIB::FilterForth m_cell_dc_voltage_b_filter;
|
|
FLTSYSLIB::FilterForth m_cell_dc_voltage_c_filter;
|
|
//
|
|
private:
|
|
//PLL-ABC & Relative Input Voltage
|
|
SYSCTRL::SignalRelative m_relative_filter_voltage_input_a;
|
|
SYSCTRL::SignalRelative m_relative_filter_voltage_input_b;
|
|
SYSCTRL::SignalRelative m_relative_filter_voltage_input_c;
|
|
FLTSYSLIB::PLLABCDVR m_pll_abc_input_voltage;
|
|
private:
|
|
//Harmonica Analyzer
|
|
FLTSYSLIB::HarmonicaFilter4Order m_voltage_input_a_harmonica_filter_5;
|
|
FLTSYSLIB::HarmonicaFilter4Order m_voltage_input_b_harmonica_filter_5;
|
|
FLTSYSLIB::HarmonicaFilter4Order m_voltage_input_c_harmonica_filter_5;
|
|
private:
|
|
//Phase Alert monitor
|
|
SYSCTRL::PhaseAlertMonitor m_phase_alert_monitor;
|
|
private:
|
|
SYSCTRL::TriggerRegisterStructure m_enable_work_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_system_fault_trigger;
|
|
private:
|
|
SYSCTRL::TriggerRegisterStructure m_q1_control_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km1_control_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km2_control_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km3_control_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km11_control_on_off_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km11t_control_on_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km11t_control_off_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km1_external_command_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_km3_external_command_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_q1_external_command_trigger;
|
|
SYSCTRL::TriggerRegisterStructure m_vs_protection_control_trigger;
|
|
|
|
private:
|
|
SYSCTRL::ContactorFault m_q1_control_fault;
|
|
SYSCTRL::ContactorFault m_km1_control_fault;
|
|
SYSCTRL::ContactorFault m_km2_control_fault;
|
|
SYSCTRL::ContactorFault m_km3_control_fault;
|
|
|
|
private:
|
|
SYSCTRL::SystemControlSetup m_system_setup;
|
|
SYSCTRL::SystemControlConfiguration m_system_configuration;
|
|
SYSCTRL::SystemEnvironment m_environment;
|
|
SYSCTRL::AlgorithmContext m_algorithm;
|
|
FRAM::FRAMDATABASE m_fram_db;
|
|
private:
|
|
MODBUSRTU::RUBUS_REGISTER_32 m_test_read_word;
|
|
MODBUSRTU::RUBUS_REGISTER_32 m_test_write_word;
|
|
MODBUSRTU::RUBUS m_rubus;
|
|
MODBUSRTU::RUBUSDataBase m_rubus_data;
|
|
uint16_t m_modbus_break_counter;
|
|
public:
|
|
SYSCTRL::HardwareAnalogCurrentFaultRegister hardware_analog_current_fault;
|
|
public:
|
|
SystemControl();
|
|
void setup();
|
|
void configure();
|
|
void reload();
|
|
public:
|
|
void process_analog_input(AnalogInput& analog_input);
|
|
void process_digital_input(DigitalInput& digital_input);
|
|
Uint32 get_digital_output();
|
|
public:
|
|
void setup_hvcell();
|
|
void send_hvcell_syn_signal();
|
|
void send_hvcell_control_order();
|
|
void set_hvcell_level();
|
|
void get_pwm_version();
|
|
void get_hvcell_state();
|
|
void get_hvcell_dc_voltage();
|
|
void get_hvcell_version();
|
|
void send_hvcell_modulate_data();
|
|
void get_cpu_cpld_version();
|
|
void hardware_diagnostic();
|
|
public:
|
|
bool slow_loop_is_active();
|
|
void slow_loop_execute();
|
|
private:
|
|
void (SystemControl::*_slow_loop_execute)();
|
|
void _slow_loop_undef();
|
|
void _slow_loop_operational();
|
|
public:
|
|
bool additional_loop_is_active();
|
|
void execute_additional();
|
|
public:
|
|
bool symmetrical_calculator_loop_is_active();
|
|
void execute_symmetrical_calculator();
|
|
private:
|
|
void (SystemControl::*_execute_additional)();
|
|
void _additional_undef();
|
|
void _additional_operational();
|
|
public:
|
|
void execute();
|
|
private:
|
|
void (SystemControl::*_execute)();
|
|
void _execute_ubdef();
|
|
void _execute_operational();
|
|
public:
|
|
void get_hard_code_setup();
|
|
void get_hard_code_configuration();
|
|
void upload_configuration();
|
|
public:
|
|
void harmonica_multiplyer(float cos_alpha, float sin_alpha, float cos_beta, float sin_beta, float& out_cos, float& out_sin);
|
|
public:
|
|
void protection_thyristor_control();
|
|
private:
|
|
void _rms_module_calculator(float xa, float xb, float xc, float& xrms);
|
|
private:
|
|
inline void _trigger_protection_thyristor_control();
|
|
public:
|
|
void inc_break_counter();
|
|
void set_break_counter(Uint16 count);
|
|
void modbusrtu_rubus_interface(Uint16 rdReg[], Uint16 wrReg[]);
|
|
private:
|
|
void _modbusrtu_rubus_read_write_register();
|
|
inline void _modbusrtu_rubus_read_write_bool(bool& param);
|
|
inline void _modbusrtu_rubus_read_write_float(float& param);
|
|
inline void _modbusrtu_rubus_read_write_uint16(uint16_t& param);
|
|
inline void _modbusrtu_rubus_read_write_uint32(uint32_t& param);
|
|
inline void _modbusrtu_rubus_read_write_int16(int16_t& param);
|
|
inline void _modbusrtu_rubus_read_write_int32(int32_t& param);
|
|
void _modbusrtu_rubus_configurate();
|
|
private:
|
|
inline float hvcell_dc_voltage_reciprocal(float& voltage);
|
|
//
|
|
};
|
|
} /* namespace SYSCTRL */
|
|
#endif /* SYSCTRL_SYSTEMCONTROL_H_ */
|