240 lines
6.9 KiB
C
240 lines
6.9 KiB
C
#include "pwm.h"
|
|
|
|
TIM_SettingsTypeDef TIM_CTRL = {0};
|
|
|
|
// variables for filling arrays
|
|
int Numb_Of_Peroids = 2; // number of periods
|
|
int Samples_Per_Peroid = 0; // how many samples in one period
|
|
int Size_Of_Log = 0; // size of written data to log
|
|
int log_ind = 0; // index of log arrays
|
|
int cnt_to_cnt_log = 0; // counter for log_cnt
|
|
|
|
int sine_ind_prev = 0;
|
|
|
|
/**
|
|
* @brief Filling logs.
|
|
* @note Заполнение логов: синус, шим, пила.
|
|
* @note This called from TIM_CTRL_Handler
|
|
*/
|
|
void Fill_Logs_with_Data(void)
|
|
{
|
|
// calc pwm duty from timer
|
|
float PWM_Duty;
|
|
if(PWM_Get_Mode(&hpwm1, PWM_DC_MODE) == 0) // if sinus need to be written
|
|
{
|
|
if(PWM_Get_Mode(&hpwm1, PWM_BRIDGE_MODE)) // if its signed sine mode (two channels)
|
|
{
|
|
if(hpwm1.Duty_Table_Ind < hpwm1.Duty_Table_Size/2) // first half get from channel 1
|
|
PWM_Duty = (((float)PWM_Get_Compare1(&hpwm1))/(PWM_Get_Autoreload(&hpwm1)))+1;
|
|
else // second half get from channel 2
|
|
PWM_Duty = 1-(((float)PWM_Get_Compare2(&hpwm1))/(PWM_Get_Autoreload(&hpwm1)));
|
|
}
|
|
else // if its unsigned sine mode (single channel)
|
|
{ // just get current pwm duty
|
|
PWM_Duty = ((float)PWM_Get_Compare1(&hpwm1)/PWM_Get_Autoreload(&hpwm1));
|
|
}
|
|
}
|
|
else // if its dc pwm mode
|
|
{ // just get current pwm duty
|
|
if(PWM_Get_Mode(&hpwm1, PWM_BRIDGE_MODE)) // if its second channels mode
|
|
PWM_Duty = ((float)PWM_Get_Compare2(&hpwm1)/PWM_Get_Autoreload(&hpwm1));
|
|
else // if its first channel mode
|
|
PWM_Duty = ((float)PWM_Get_Compare1(&hpwm1)/PWM_Get_Autoreload(&hpwm1));
|
|
}
|
|
|
|
|
|
|
|
// WRITE SINUS TO WHOLE ARRAY
|
|
// sine_log[log_ind] = sin_val;
|
|
if(PWM_Get_Mode(&hpwm1,PWM_DC_MODE) == 0) // in table mode write PWM Duty (write sine) with scale 1/2 from sin table max value (0xFFFF/2)
|
|
sine_log[log_ind] = PWM_Duty*(0x8000-1);
|
|
else // in dc mode write PWM Duty (write sine)
|
|
sine_log[log_ind] = 0;
|
|
|
|
|
|
|
|
// WRITE PWM
|
|
if(PWM_Get_Mode(&hpwm1,PWM_DC_MODE)) // in DC mode
|
|
{
|
|
// write 1 - if log_ind < Size_Of_Period*PWM_Dury
|
|
// write 0 - otherwise
|
|
pwm_log[log_ind] = (log_ind%(Size_Of_Log/Numb_Of_Peroids) < (Size_Of_Log/Numb_Of_Peroids+1)*hpwm1.PWM_Value/100)? 1: 0;
|
|
}
|
|
else // in table mode
|
|
{
|
|
// write fill whole pwm array at one interrupt
|
|
int PWM_Period_End_Ind = (Size_Of_Log/Numb_Of_Peroids);
|
|
int PWM_Step_End_Ind;
|
|
if(PWM_Get_Mode(&hpwm1,PWM_BRIDGE_MODE))
|
|
PWM_Step_End_Ind = PWM_Period_End_Ind*fabs(PWM_Duty-1);
|
|
else
|
|
PWM_Step_End_Ind = PWM_Period_End_Ind*PWM_Duty;
|
|
for(int i = 0; i <= PWM_Step_End_Ind; i++)
|
|
{
|
|
for (int j = 0; j < Numb_Of_Peroids; j++)
|
|
pwm_log[i+j*PWM_Period_End_Ind] = 1;
|
|
}
|
|
for(int i = PWM_Step_End_Ind+1; i < PWM_Period_End_Ind; i++)
|
|
for (int j = 0; j < Numb_Of_Peroids; j++)
|
|
pwm_log[i+j*PWM_Period_End_Ind] = 0;
|
|
}
|
|
|
|
// WRITE COUNTER
|
|
cnt_log[log_ind] = cnt_to_cnt_log;
|
|
cnt_to_cnt_log++;
|
|
if(cnt_to_cnt_log>=Size_Of_Log/2)
|
|
cnt_to_cnt_log = 0;
|
|
|
|
// INCREMENT AND RESET COUNTER
|
|
log_ind++;
|
|
if(PWM_Get_Mode(&hpwm1,PWM_DC_MODE) == 0) // if its PWM table mode
|
|
{
|
|
// SYNCHRONIZE PERIOD OF SIN IN LOG
|
|
// (это надо, чтобы данные не съезжали из-за несинхронизированного периода)
|
|
|
|
// wait until period ended
|
|
if(log_ind>Size_Of_Log-1) // if logs are filled
|
|
{
|
|
if((unsigned)hpwm1.Duty_Table_Ind < sine_ind_prev) // and if new period started
|
|
{
|
|
log_ind = 0; // reset counter
|
|
sine_ind_prev = (unsigned)hpwm1.Duty_Table_Ind;
|
|
}
|
|
}
|
|
// update prev variable only if log currently writing
|
|
else
|
|
sine_ind_prev = (unsigned)hpwm1.Duty_Table_Ind;
|
|
}
|
|
else // if its PWM DC mode
|
|
{
|
|
// if logs are filled
|
|
if(log_ind>Size_Of_Log-1)
|
|
log_ind = 0;
|
|
}
|
|
|
|
|
|
// if its overflow log array size - reset log_ind
|
|
if(log_ind>LOG_SIZE-1)
|
|
{
|
|
log_ind = 0;
|
|
sine_ind_prev = (unsigned)hpwm1.Duty_Table_Ind;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Update log parameters.
|
|
* @note Проверка надо ли обновлять параметры логов, и если надо - обновляет их.
|
|
* @note This called from TIM_CTRL_Handler
|
|
*/
|
|
void Update_Params_For_Log(void)
|
|
{
|
|
unsigned UpdateLog = 0;
|
|
|
|
// READ NUMB OF PERIOD IN LOGS
|
|
if(Numb_Of_Peroids != log_ctrl[R_LOG_CTRL_LOG_PWM_NUMB])
|
|
{
|
|
Numb_Of_Peroids = log_ctrl[R_LOG_CTRL_LOG_PWM_NUMB];
|
|
// update logs params
|
|
UpdateLog = 1;
|
|
}
|
|
// READ SIZE OF LOGS
|
|
if(Size_Of_Log != log_ctrl[R_LOG_CTRL_LOG_SIZE])
|
|
{
|
|
Size_Of_Log = log_ctrl[R_LOG_CTRL_LOG_SIZE];
|
|
// update logs params
|
|
UpdateLog = 1;
|
|
}
|
|
|
|
// UPDATE LOG PARAMS
|
|
if(UpdateLog)
|
|
{
|
|
// set logs params
|
|
Set_Log_Params();
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Set up log parameters.
|
|
* @note Устанавливает настройки логов и проверяет их на корректность.
|
|
*/
|
|
void Set_Log_Params(void)
|
|
{
|
|
// SET LOG PARAMS
|
|
log_ind = 0;
|
|
Samples_Per_Peroid = TIM_CTRL.sTimFreqHz/hpwm1.PWM_Value;
|
|
|
|
if(Size_Of_Log > LOG_SIZE) // if its too much data in log
|
|
{
|
|
Numb_Of_Peroids = (LOG_SIZE/Samples_Per_Peroid);
|
|
log_ctrl[R_LOG_CTRL_LOG_SIZE] = Numb_Of_Peroids;
|
|
Size_Of_Log = Numb_Of_Peroids*Samples_Per_Peroid;
|
|
}
|
|
|
|
// clear logs arrays
|
|
for(int i = Size_Of_Log; i < LOG_SIZE; i++)
|
|
{
|
|
sine_log[i] = 0;
|
|
pwm_log[i] = 0;
|
|
cnt_log[i] = 0;
|
|
}
|
|
|
|
}
|
|
|
|
/**
|
|
* @brief reInitialization of control timer.
|
|
* @note Перенастраивает таймер согласно принятным настройкам в log_ctrl.
|
|
* @note This called from main while
|
|
*/
|
|
void Control_Timer_ReInit(TIM_SettingsTypeDef *stim)
|
|
{
|
|
TIM_Base_MspDeInit(&stim->htim);
|
|
hpwm1.stim.sTickBaseMHz = PROJSET_MEM->TIM_CTRL_TICKBASE;
|
|
TIM_Base_Init(stim);
|
|
|
|
HAL_TIM_Base_Start_IT(&stim->htim); // timer for sinus
|
|
HAL_NVIC_SetPriority(TIM8_BRK_TIM12_IRQn, 1, 1);
|
|
}
|
|
/**
|
|
* @brief First initialization of Control Timer.
|
|
* @note Первый управляющего таймера. Таймер записывает логи и обновляет параметры ШИМ.
|
|
* @note This called from main
|
|
*/
|
|
void Control_Timer_FirstInit(void)
|
|
{
|
|
//-------CONTROL TIMER INIT----------
|
|
// tim settings
|
|
TIM_CTRL.htim.Instance = TIMER_CTRL_INSTANCE;
|
|
TIM_CTRL.sTimMode = TIM_IT_MODE;
|
|
TIM_CTRL.sTickBaseMHz = PROJSET.TIM_CTRL_TICKBASE;
|
|
TIM_CTRL.sTimAHBFreqMHz = PROJSET.TIM_CTRL_AHB_FREQ;
|
|
TIM_CTRL.sTimFreqHz = HZ_TIMER_CTRL;
|
|
|
|
TIM_Base_Init(&TIM_CTRL);
|
|
HAL_NVIC_SetPriority(TIM8_TRG_COM_TIM14_IRQn, 1, 1);
|
|
|
|
HAL_TIM_Base_Start_IT(&TIM_CTRL.htim); // timer for sinus
|
|
|
|
|
|
// FILL TIME ARRAY WITH TIME
|
|
for(int i = 0; i <= R_TIME_LOG_QNT; i++)
|
|
time_log[i] = i;
|
|
|
|
}
|
|
//-------------------------------------------------------------------
|
|
//------------------------HANDLERS FUNCTIONS-------------------------
|
|
//-------------CONTROL TIMER---------------
|
|
void TIM8_UP_TIM13_IRQHandler(void)
|
|
{
|
|
/* TIM_CTRL_Handler */
|
|
Trace_CTRL_TIM_Enter();
|
|
HAL_TIM_IRQHandler(&TIM_CTRL.htim);
|
|
|
|
Fill_Logs_with_Data();
|
|
Update_Params_For_Log();
|
|
Update_Params_For_PWM(&hpwm1);
|
|
|
|
WriteSettingsToMem();
|
|
|
|
Trace_CTRL_TIM_Exit();
|
|
}
|