Типа запустилось, но все равно есть проблемы с расчетом угла

MATLAB/MCU_STM32_Matlab/Drivers/STM32_SIMULINK/stm32_matlab_tim.c

@@ -250,7 +250,7 @@ void CC_PWM_Ch3_Simulation(TIM_TypeDef *TIMx, struct TIM_Sim *TIMS)
 }
 void CC_PWM_Ch4_Simulation(TIM_TypeDef *TIMx, struct TIM_Sim *TIMS)
 { // определяет режим канала
-    switch (TIMx->CCMR1 & TIM_CCMR1_OC2M)
+    switch (TIMx->CCMR2 & TIM_CCMR1_OC2M)
     {
         case ((TIM_OCMODE_ACTIVE) << (TIM_OCMODE_SECOND_SHIFT)): // ACTIVE mode
             if (abs(TIMx->CNT - TIMx->CCR4) < 2*TIMS->tx_step) 

MATLAB/MCU_STM32_Matlab/stm32_matlab_conf.c

@@ -43,8 +43,10 @@ void deInitialize_MCU(void)
 	memset(&MCU_CORTEX_MEM, 0, sizeof(MCU_CORTEX_MEM));
 	memset(&htim1, 0, sizeof(htim1));
 
-		
+
+	ClearStruct(upp);
 	ClearStruct(htim1);
+	ClearStruct(htim2);
 	ClearStruct(htim3);
 	ClearStruct(htim8);
 	ClearStruct(htim11);
@@ -107,7 +109,7 @@ struct TIM_Sim tim14s;
 void Init_TIM_SIM(void)
 {
 #ifdef USE_TIM1    
-    memset(&tim1s, 0, sizeof(tim1s));
+  memset(&tim1s, 0, sizeof(tim1s));
 	tim1s.tx_cnt = TIM1->CNT;
 	tim1s.tx_step = hmcu.sSimSampleTime * ABP2_TIMS_Value;
 
@@ -121,7 +123,7 @@ void Init_TIM_SIM(void)
 	tim1s.Channels.OC4_PIN_SHIFT = 11;
 #endif
 #ifdef USE_TIM2
-    memset(&tim2s, 0, sizeof(tim2s));
+  memset(&tim2s, 0, sizeof(tim2s));
 	tim2s.tx_cnt = TIM2->CNT;
 	tim2s.tx_step = hmcu.sSimSampleTime * ABP1_TIMS_Value;
 
@@ -135,7 +137,7 @@ void Init_TIM_SIM(void)
 	tim2s.Channels.OC4_PIN_SHIFT = 3;
 #endif
 #ifdef USE_TIM3
-    memset(&tim3s, 0, sizeof(tim3s));
+  memset(&tim3s, 0, sizeof(tim3s));
 	tim3s.tx_cnt = TIM3->CNT;
 	tim3s.tx_step = hmcu.sSimSampleTime * ABP1_TIMS_Value;
 
@@ -149,7 +151,7 @@ void Init_TIM_SIM(void)
 	tim3s.Channels.OC4_PIN_SHIFT = 9;
 #endif
 #ifdef USE_TIM4	
-    memset(&tim4s, 0, sizeof(tim4s));
+  memset(&tim4s, 0, sizeof(tim4s));
 	tim4s.tx_cnt = TIM4->CNT;
 	tim4s.tx_step = hmcu.sSimSampleTime * ABP1_TIMS_Value;
 
@@ -163,7 +165,7 @@ void Init_TIM_SIM(void)
 	tim4s.Channels.OC4_PIN_SHIFT = 9;
 #endif
 #ifdef USE_TIM5
-    memset(&tim5s, 0, sizeof(tim5s));
+  memset(&tim5s, 0, sizeof(tim5s));
 	tim5s.tx_cnt = TIM5->CNT;
 	tim5s.tx_step = hmcu.sSimSampleTime * ABP1_TIMS_Value;
 
@@ -177,7 +179,7 @@ void Init_TIM_SIM(void)
 	tim5s.Channels.OC4_PIN_SHIFT = 3;
 #endif
 #ifdef USE_TIM6
-    memset(&tim6s, 0, sizeof(tim6s));
+  memset(&tim6s, 0, sizeof(tim6s));
 	tim6s.tx_cnt = TIM6->CNT;
 	tim6s.tx_step = hmcu.sSimSampleTime * ABP1_TIMS_Value;
 

MATLAB/MCU_Wrapper/mcu_wrapper_conf.h

@@ -79,7 +79,7 @@
   * @param _arr_ind_ Индекс выходного порта
   * @param _val_ind_ Индекс элемента в выходном массиве
   */
-#define	WriteOutputArray(_var_, _arr_ind_, _val_ind_)	__WriteOutputArray(Buffer, (float)_var_, _arr_ind_, _val_ind_)
+#define	WriteOutputArray(_var_, _arr_ind_, _val_ind_)	__WriteOutputArray(Buffer, (float)(_var_), _arr_ind_, _val_ind_)
 
 /** @brief Считывает значение из входного массива блока S-Function
   * @param _var_ Значение, которое необходимо записать (будет преобразовано в float)

MATLAB/app_wrapper/app_io.c

@@ -6,7 +6,9 @@
 #include "mcu_wrapper_conf.h"
 #include "app_wrapper.h"
 
-#define PIN_READ(_verbname_) (_verbname_##_GPIO_Port->ODR & (_verbname_##_Pin)) ? 1 : 0
+float dbg[16];
+
+#define PIN_READ(_verbname_) (_verbname_##_GPIO_Port->ODR & (_verbname_##_Pin)) ? 0 : 1
 
 void Write_Thyristors(real_T* Buffer, int ind_port)
 {
@@ -75,11 +77,14 @@ void app_readInputs(const real_T* Buffer) {
 void app_writeOutputBuffer(real_T* Buffer) {
 // USER APP OUTPUT START
 	Write_Thyristors(Buffer, 0);
+
 	Write_PowerMonitor(Buffer, 1);
 
 
-	WriteOutputArray(TIM2->CNT, 2, 0);
-	WriteOutputArray(TIM2->CCR1, 2, 1);
-	
+	int nn = 0;
+	WriteOutputArray(upp.hangle.htim->Instance->CNT, 2, nn++);
+	WriteOutputArray(upp.hangle.htim->Instance->CCR1, 2, nn++);
+	WriteOutputArray(upp.hangle.htim->Instance->CCR2, 2, nn++);
+	WriteOutputArray(upp.hangle.htim->Instance->CCR3, 2, nn++);
 // USER APP OUTPUT END
 }