2025-01-15 11:01:26 +03:00
|
|
|
|
/**
|
|
|
|
|
**************************************************************************
|
|
|
|
|
* @file mcu_wrapper.c
|
|
|
|
|
* @brief Исходный код оболочки МК.
|
|
|
|
|
**************************************************************************
|
|
|
|
|
@details
|
|
|
|
|
Данный файл содержит функции для симуляции МК в Simulink (S-Function).
|
|
|
|
|
**************************************************************************/
|
|
|
|
|
#include "mcu_wrapper_conf.h"
|
|
|
|
|
#include "init28335.h"
|
|
|
|
|
#include "param.h"
|
|
|
|
|
#include "pwm_sim.h"
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* @addtogroup WRAPPER_CONF
|
|
|
|
|
* @{
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
SIM__MCUHandleTypeDef hmcu; ///< Хендл для управления потоком программы МК
|
|
|
|
|
|
|
|
|
|
/** MCU_WRAPPER
|
|
|
|
|
* @}
|
|
|
|
|
*/
|
|
|
|
|
//-------------------------------------------------------------//
|
|
|
|
|
//-----------------CONTROLLER SIMULATE FUNCTIONS---------------//
|
|
|
|
|
/* THREAD FOR MCU APP */
|
|
|
|
|
#ifdef RUN_APP_THRREAD
|
|
|
|
|
/**
|
|
|
|
|
* @brief Главная функция приложения МК.
|
|
|
|
|
* @details Функция с которой начинается выполнение кода МК. Выход из данной функции происходит только в конце симуляции @ref mdlTerminate
|
|
|
|
|
*/
|
|
|
|
|
extern int main(void); // extern while from main.c
|
|
|
|
|
/**
|
|
|
|
|
* @brief Поток приложения МК.
|
|
|
|
|
* @details Поток, который запускает и выполняет код МК (@ref main).
|
|
|
|
|
*/
|
|
|
|
|
unsigned __stdcall MCU_App_Thread(void) {
|
|
|
|
|
main(); // run MCU code
|
|
|
|
|
return 0; // end thread
|
|
|
|
|
// note: this return will reached only at the end of simulation, when all whiles will be skipped due to @ref sim_while
|
|
|
|
|
}
|
|
|
|
|
#endif //RUN_APP_THRREAD
|
|
|
|
|
/* SIMULATE MCU FOR ONE SIMULATION STEP */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Симуляция МК на один такт симуляции.
|
|
|
|
|
* @param S - указатель на структуру S-Function из "simstruc.h"
|
|
|
|
|
* @param time - текущее время симуляции.
|
|
|
|
|
* @details Запускает поток, который выполняет код МК и управляет ходом потока:
|
|
|
|
|
* Если прошел таймаут, поток прерывается, симулируется периферия
|
|
|
|
|
* и на следующем шаге поток возобнавляется.
|
|
|
|
|
*
|
|
|
|
|
* Вызывается из mdlUpdate()
|
|
|
|
|
*/
|
|
|
|
|
void MCU_Step_Simulation(SimStruct* S, time_T time)
|
|
|
|
|
{
|
|
|
|
|
hmcu.SystemClockDouble += hmcu.SystemClock_step; // emulate core clock
|
|
|
|
|
hmcu.SystemClock = hmcu.SystemClockDouble;
|
|
|
|
|
hmcu.SimTime = time;
|
|
|
|
|
|
|
|
|
|
MCU_readInputs(S); // считывание портов
|
|
|
|
|
|
|
|
|
|
MCU_Periph_Simulation(); // simulate peripheral
|
|
|
|
|
|
|
|
|
|
#ifdef RUN_APP_THRREAD
|
|
|
|
|
ResumeThread(hmcu.hMCUThread);
|
|
|
|
|
for (int i = DEKSTOP_CYCLES_FOR_MCU_APP; i > 0; i--)
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
SuspendThread(hmcu.hMCUThread);
|
|
|
|
|
#endif //RUN_APP_THRREAD
|
|
|
|
|
|
|
|
|
|
MCU_writeOutputs(S); // запись портов (по факту запись в буфер. запись в порты в mdlOutputs)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* SIMULATE MCU PERIPHERAL */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Симуляция периферии МК
|
|
|
|
|
* @details Пользовательский код, который симулирует работу периферии МК.
|
|
|
|
|
*/
|
|
|
|
|
void MCU_Periph_Simulation(void)
|
|
|
|
|
{
|
|
|
|
|
Simulate_Timers();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* READ INPUTS S-FUNCTION TO MCU REGS */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Считывание входов S-Function в порты ввода-вывода.
|
|
|
|
|
* @param S - указатель на структуру S-Function из "simstruc.h"
|
2025-01-15 12:35:47 +03:00
|
|
|
|
* @details Пользовательский код, который записывает входы МК из входов S-Function.
|
2025-01-15 11:01:26 +03:00
|
|
|
|
*/
|
|
|
|
|
void MCU_readInputs(SimStruct* S)
|
|
|
|
|
{
|
|
|
|
|
/* Get S-Function inputs */
|
|
|
|
|
real_T* IN = ssGetInputPortRealSignal(S, 0);
|
|
|
|
|
|
|
|
|
|
readInputParameters(IN);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* WRITE OUTPUTS BUFFER S-FUNCTION FROM MCU REGS*/
|
|
|
|
|
/**
|
|
|
|
|
* @brief Запись портов ввода-вывода в буфер выхода S-Function
|
|
|
|
|
* @param S - указатель на структуру S-Function из "simstruc.h"
|
|
|
|
|
* @details Пользовательский код, который записывает буфер выходов S-Function из портов ввода-вывода.
|
|
|
|
|
*/
|
|
|
|
|
void MCU_writeOutputs(SimStruct* S)
|
|
|
|
|
{
|
|
|
|
|
/* Get S-Function descrete array */
|
|
|
|
|
real_T* Out_Buff = ssGetDiscStates(S);
|
|
|
|
|
|
|
|
|
|
writeOutputParameters(Out_Buff);
|
|
|
|
|
}
|
|
|
|
|
//-----------------CONTROLLER SIMULATE FUNCTIONS---------------//
|
|
|
|
|
//-------------------------------------------------------------//
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//-------------------------------------------------------------//
|
|
|
|
|
//----------------------SIMULINK FUNCTIONS---------------------//
|
|
|
|
|
/* MCU WRAPPER DEINITIALIZATION */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Инициализация симуляции МК.
|
|
|
|
|
* @details Пользовательский код, который создает поток для приложения МК
|
|
|
|
|
и настраивает симулятор МК для симуляции.
|
|
|
|
|
*/
|
|
|
|
|
void SIM_Initialize_Simulation(void)
|
|
|
|
|
{
|
|
|
|
|
#ifdef RUN_APP_THRREAD
|
2025-01-15 12:35:47 +03:00
|
|
|
|
// инициализация потока, который будет выполнять код МК
|
2025-01-15 11:01:26 +03:00
|
|
|
|
hmcu.hMCUThread = (HANDLE)CreateThread(NULL, 0, MCU_App_Thread, 0, CREATE_SUSPENDED, &hmcu.idMCUThread);
|
|
|
|
|
#endif //RUN_APP_THRREAD
|
2025-01-15 12:35:47 +03:00
|
|
|
|
|
2025-01-15 11:01:26 +03:00
|
|
|
|
/* user initialization */
|
|
|
|
|
Init_Timers();
|
|
|
|
|
init28335();
|
|
|
|
|
|
2025-01-15 12:35:47 +03:00
|
|
|
|
/* clock step initialization */
|
2025-01-15 11:01:26 +03:00
|
|
|
|
hmcu.SystemClock_step = MCU_CORE_CLOCK * hmcu.SimSampleTime; // set system clock step
|
|
|
|
|
}
|
|
|
|
|
/* MCU WRAPPER DEINITIALIZATION */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Деинициализация симуляции МК.
|
|
|
|
|
* @details Пользовательский код, который будет очищать все структуры после окончания симуляции.
|
|
|
|
|
*/
|
|
|
|
|
void SIM_deInitialize_Simulation(void)
|
|
|
|
|
{
|
|
|
|
|
//// simulate structures of peripheral deinitialization
|
|
|
|
|
//deInitialize_Periph_Sim();
|
|
|
|
|
//// mcu peripheral memory deinitialization
|
|
|
|
|
//deInitialize_MCU();
|
|
|
|
|
}
|
|
|
|
|
/* WRITE OUTPUTS OF S-BLOCK */
|
|
|
|
|
/**
|
|
|
|
|
* @brief Формирование выходов S-Function.
|
|
|
|
|
* @param S - указатель на структуру S-Function из "simstruc.h"
|
|
|
|
|
* @details Пользовательский код, который записывает выходы S-Function из буфера.
|
|
|
|
|
*/
|
|
|
|
|
void SIM_writeOutputs(SimStruct* S)
|
|
|
|
|
{
|
|
|
|
|
real_T* GPIO;
|
|
|
|
|
real_T* Out_Buff = ssGetDiscStates(S);
|
|
|
|
|
|
|
|
|
|
//-------------WRITTING GPIOS---------------
|
|
|
|
|
for (int j = 0; j < OUT_PORT_NUMB; j++)
|
|
|
|
|
{
|
|
|
|
|
GPIO = ssGetOutputPortRealSignal(S, j);
|
|
|
|
|
for (int i = 0; i < OUT_PORT_WIDTH; i++)
|
|
|
|
|
{
|
|
|
|
|
GPIO[i] = Out_Buff[j * OUT_PORT_WIDTH + i];
|
|
|
|
|
Out_Buff[j * OUT_PORT_WIDTH + i] = 0;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
//------------------------------------------
|
|
|
|
|
}
|
|
|
|
|
//-------------------------------------------------------------//
|