Razvalyaev/matlab_stm_emulate
9
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Добавлен ForceDisconnect

Browse Source
This commit is contained in:
Razvalyaev 2025-05-16 13:46:26 +03:00
parent 1c5ce14f0f
commit 6392d35129
3 changed files with 7 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
App_Wrapper/app_io.c
View File

@ -32,7 +32,7 @@ void WriteFromSFunc(real_T* disc)
} }
} }
disc[2 * PORT_WIDTH + 0] = phase_A.ctrl.angle.delay_us; disc[2 * PORT_WIDTH + 0] = phase_A.ctrl.angle.delay_us;
disc[2 * PORT_WIDTH + 1] = (uint16_t)((uint16_t)TIMER->CNT - phase_A.ctrl.angle.start_delay_tick); disc[2 * PORT_WIDTH + 1] = ((uint16_t)TIMER->CNT - phase_A.ctrl.angle.start_delay_tick);
disc[2 * PORT_WIDTH + 2] = phase_A.ctrl.angle.start_delay_tick; disc[2 * PORT_WIDTH + 2] = phase_A.ctrl.angle.start_delay_tick;
disc[2 * PORT_WIDTH + 3] = TIMER->CNT; disc[2 * PORT_WIDTH + 3] = TIMER->CNT;
} }
@ -61,9 +61,12 @@ void ReadToSFunc(real_T* in)
detect_front(5, Upp.ForceStop, 1); detect_front(5, Upp.ForceStop, 1);
detect_rise(5, Upp.ForceStop, 0); detect_rise(5, Upp.ForceStop, 0);
detect_front(6, Upp.ForceDisconnect, 1);
detect_rise(6, Upp.ForceDisconnect, 0);
Upp.sine_freq = in[6];
Upp.Duration = in[7]; Upp.sine_freq = in[7];
Upp.Duration = in[8];
for (int i = 0; i < IN_PORT_WIDTH; i++) for (int i = 0; i < IN_PORT_WIDTH; i++)

2
MCU_Wrapper/mcu_wrapper_conf.h
View File

@ -56,7 +56,7 @@
#define PORT_NUMB 3 ///< amount of ports #define PORT_NUMB 3 ///< amount of ports
// Parameters of S_Function // Parameters of S_Function
#define NPARAMS 1 ///< number of input parametrs (only Ts) #define NPARAMS 1 ///< number of input parametrs (only Ts)
#define IN_PORT_WIDTH (8) ///< width of input ports #define IN_PORT_WIDTH (9) ///< width of input ports
#define IN_PORT_NUMB 1 ///< number of input ports #define IN_PORT_NUMB 1 ///< number of input ports
#define OUT_PORT_WIDTH PORT_WIDTH ///< width of output ports #define OUT_PORT_WIDTH PORT_WIDTH ///< width of output ports
#define OUT_PORT_NUMB PORT_NUMB ///< number of output ports #define OUT_PORT_NUMB PORT_NUMB ///< number of output ports

BIN
mcu_test_r2023.slx
View File

Binary file not shown.