Author SHA1 Message Date
fewikay efbbbb73e2 included config mmperturn, stepsperturn 2026-11-13 15:56:00 +01:00
fewikay e67abc6889 added flags -r, -s to move 2026-11-13 15:40:37 +01:00
fewikay 8071f4c246 config finished except stepsperturn, mmperturn 2026-11-13 14:19:48 +01:00
fewikay 65502c60f0 update config 2026-11-12 10:32:18 +01:00
fewikay f746a3fc2d started config function 2026-11-12 10:13:41 +01:00
fewikay 6a6a1589ee LEDS fix 2026-11-06 14:26:37 +01:00
fewikay fef883dca4 Test Pulse mit Timer 1 (Master) und Timer 4 (Slave) 2026-11-05 21:15:46 +01:00
9 changed files with 848 additions and 149 deletions

No files matched your search

@@ -5,7 +5,7 @@
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1232117135261576401" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true"> <provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1781085212299121332" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true">
<language-scope id="org.eclipse.cdt.core.gcc"/> <language-scope id="org.eclipse.cdt.core.gcc"/>
<language-scope id="org.eclipse.cdt.core.g++"/> <language-scope id="org.eclipse.cdt.core.g++"/>
</provider> </provider>
@@ -16,7 +16,7 @@
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1232117135261576401" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true"> <provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1781085212299121332" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true">
<language-scope id="org.eclipse.cdt.core.gcc"/> <language-scope id="org.eclipse.cdt.core.gcc"/>
<language-scope id="org.eclipse.cdt.core.g++"/> <language-scope id="org.eclipse.cdt.core.g++"/>
</provider> </provider>
@@ -5,7 +5,7 @@
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1170989325916314487" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true"> <provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1842213021644383246" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true">
<language-scope id="org.eclipse.cdt.core.gcc"/> <language-scope id="org.eclipse.cdt.core.gcc"/>
<language-scope id="org.eclipse.cdt.core.g++"/> <language-scope id="org.eclipse.cdt.core.g++"/>
</provider> </provider>
@@ -16,7 +16,7 @@
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/> <provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1170989325916314487" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true"> <provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1842213021644383246" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD &quot;${INPUTS}&quot;" prefer-non-shared="true">
<language-scope id="org.eclipse.cdt.core.gcc"/> <language-scope id="org.eclipse.cdt.core.gcc"/>
<language-scope id="org.eclipse.cdt.core.g++"/> <language-scope id="org.eclipse.cdt.core.g++"/>
</provider> </provider>
@@ -105,10 +105,11 @@ void Error_Handler(void);
#define LED_YELLOW_GPIO_Port GPIOE #define LED_YELLOW_GPIO_Port GPIOE
/* USER CODE BEGIN Private defines */ /* USER CODE BEGIN Private defines */
extern TIM_HandleTypeDef htim1;
/* USER CODE END Private defines */
extern TIM_HandleTypeDef htim2; extern TIM_HandleTypeDef htim2;
extern TIM_HandleTypeDef htim4;
extern TIM_HandleTypeDef htim3;
extern TIM_HandleTypeDef htim12;
extern SPI_HandleTypeDef hspi1; extern SPI_HandleTypeDef hspi1;
void green_led(); void green_led();
@@ -116,6 +117,7 @@ void red_led();
void blink_yellow_led(); void blink_yellow_led();
void yellow_led_start(); void yellow_led_start();
void yellow_led_stop(); void yellow_led_stop();
/* USER CODE END Private defines */
#ifdef __cplusplus #ifdef __cplusplus
} }
@@ -19,7 +19,7 @@ static void SPINDLE_SetDutyCycle(SpindleHandle_t h, void* context, int backwards
__HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_4, pulse); __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_4, pulse);
} }
//printf("duty=%f backwards=%d pulse=%lu\n", dutyCycle, backwards, (unsigned long)pulse); printf("duty=%f backwards=%d pulse=%lu\n", dutyCycle, backwards, (unsigned long)pulse);
} }
@@ -1,8 +1,19 @@
#include "Stepper/stepper.h" #include "Stepper/stepper.h"
#include "LibL6474.h" #include "LibL6474.h"
#include "main.h" #include "main.h"
#include "semphr.h"
// TIM4 (Pulse an PD15) laeuft mit 200 MHz / 128, TIM1 zaehlt die Pulse (16 Bit)
#define STEP_TICK_HZ 1562500u //TIM4 Takt
#define STEP_CHUNK 60000u //TIM1 16 Bit:
#define STEP_HZ_MOVE 4000u // 300 mm/min bei 800 Schritten/mm
#define STEP_HZ_REFERENCE 500u // 37,5 mm/min bei 800 Schritten/mm
#define STEP_POLL_MS 50u // Treiberstatus-Abfrage waehrend der Fahrt
static SemaphoreHandle_t stepDone;
static volatile unsigned int stepsLeft = 0;
static unsigned int stepHz = STEP_HZ_MOVE;
static L6474_Handle_t stepperHandle = NULL;
/* /*
* States: * States:
@@ -12,9 +23,18 @@
*/ */
int state = 0; int state = 0;
float posmax = 295;
float posmin = 0.0f;
float posref = 0.0f;
// Spindelsteigung 4 mm, Motor 200 Vollschritte pro Umdrehung (Pflichtenheft)
float mmperturn = 4;
int stepsperturn = 200;
// eingestellter Step Mode: 1, 2, 4, 8 oder 16
int microsteps = 16;
// 200 / 4 = 50 Vollschritte pro mm, bei 1/16 Schritt also 800 Schritte pro mm
int mm_to_step(float mm){ int mm_to_step(float mm){
return (int)(800 * mm); return (int)(stepsperturn * microsteps * mm / mmperturn);
} }
static void* StepLibraryMalloc( unsigned int size ){ static void* StepLibraryMalloc( unsigned int size ){
@@ -47,7 +67,299 @@ void StepLibraryDelay(unsigned int ms){
vTaskDelay(pdMS_TO_TICKS(ms)); vTaskDelay(pdMS_TO_TICKS(ms));
} }
// 1) Funktion schreiben (oben in stepper.c, vor init_stepper) // 1 wenn der Treiber nicht fahrbereit ist. L6474_GetStatus selbst meldet nur SPI-Fehler,
// die Flags muessen hier ausgewertet werden. HIGHZ bleibt nach OCD/UVLO/TH_SD stehen.
static int StepperHasFault(L6474_Handle_t s){
L6474_Status_t status;
if(L6474_GetStatus(s, &status) != errcNONE){
return 1;
}
return status.HIGHZ || status.UVLO || status.TH_SD || status.OCD;
}
// Pulsfrequenz einstellen, nur aufrufen wenn gerade keine Pulse laufen
static void StepTimerSetSpeed(unsigned int hz){
// hz gilt fuer 1/16 Schritt, bei anderem Step Mode gleiche mm/min halten
hz = hz * microsteps / 16;
uint32_t arr = (STEP_TICK_HZ / hz) - 1;
stepHz = hz;
TIM4->ARR = arr;
TIM4->CCR4 = (arr + 1) / 2; // 50 % Duty
TIM4->EGR = TIM_EGR_UG; // Werte uebernehmen, Zaehler auf 0
}
// TIM1 auf die naechsten n Pulse stellen und starten, das oeffnet das Gate von TIM4
static void StepTimerStartChunk(void){
unsigned int n;
if(stepsLeft > STEP_CHUNK){
n = STEP_CHUNK;
}else{
n = stepsLeft;
}
stepsLeft -= n;
TIM1->CNT = 0;
TIM1->CCR1 = n;
TIM1->SR = ~TIM_SR_CC1IF;
TIM1->CR1 |= TIM_CR1_CEN;
}
// Wird ueber TIM1_CC_IRQHandler aufgerufen, sobald TIM1 n Pulse gezaehlt hat
void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef *htim){
if(htim->Instance != TIM1){
return;
}
TIM1->CR1 &= ~TIM_CR1_CEN; // Gate zu
if(stepsLeft > 0){
StepTimerStartChunk();
return;
}
BaseType_t woken = pdFALSE;
xSemaphoreGiveFromISR(stepDone, &woken);
portYIELD_FROM_ISR(woken);
}
// Name des Config-Parameters in die Nummer fuer config_stepper wandeln, 0 wenn unbekannt
static int config_param_id(const char* name){
if(strcmp(name, "torque") == 0){
return 1;
}else if(strcmp(name, "throvercurr") == 0){
return 2;
}else if(strcmp(name, "powerena") == 0){
return 3;
}else if(strcmp(name, "stepmode") == 0){
return 4;
}else if(strcmp(name, "timeoff") == 0){
return 5;
}else if(strcmp(name, "timeon") == 0){
return 6;
}else if(strcmp(name, "timefast") == 0){
return 7;
}else if(strcmp(name, "mmperturn") == 0){
return 8;
}else if(strcmp(name, "posmax") == 0){
return 9;
}else if(strcmp(name, "posmin") == 0){
return 10;
}else if(strcmp(name, "posref") == 0){
return 11;
}else if(strcmp(name, "stepsperturn") == 0){
return 12;
}
return 0;
}
static int config_stepper(L6474_Handle_t s, int param, float value){
/*
* param 1: torque (mA)
* param 2: throvercurr (mA)
* param 3: powerena (0 oder 1)
* param 4: stepmode (1, 2, 4, 8, 16)
* param 5: timeoff (us)
* param 6: timeon (us)
* param 7: timefast (us)
* param 8: mmperturn
* param 9: posmax
* param 10: posmin
* param 11: posref
* param 12: stepsperturn
*/
int reg = 0;
int result = 0;
switch(param){
case 1:
result = L6474_SetProperty(s, L6474_PROP_TORQUE, L6474_EncodePhaseCurrent(value));
break;
case 2:
// 375 mA pro Stufe, Register 0 = 375 mA
if(value < 375 || value > 6000){
return 1;
}
reg = (int)(value / 375) - 1;
result = L6474_SetProperty(s, L6474_PROP_OCDTH, reg);
break;
case 3:
if(value == 1){
result = L6474_SetPowerOutputs(s, 1);
}else{
result = L6474_SetPowerOutputs(s, 0);
}
break;
case 4:
if(value == 1){
result = L6474_SetStepMode(s, smFULL);
}else if(value == 2){
result = L6474_SetStepMode(s, smHALF);
}else if(value == 4){
result = L6474_SetStepMode(s, smMICRO4);
}else if(value == 8){
result = L6474_SetStepMode(s, smMICRO8);
}else if(value == 16){
result = L6474_SetStepMode(s, smMICRO16);
}else{
return 1;
}
if(result == errcNONE){
microsteps = (int)value;
// Position stimmt nicht mehr, neue Referenzfahrt noetig
if(state == 2){
state = 1;
}
}
break;
case 5:
// 0.5 us pro Stufe, Register 0 = 0.5 us
if(value < 0.5f || value > 64){
return 1;
}
reg = (int)(value * 2) - 1;
result = L6474_SetProperty(s, L6474_PROP_TOFF, reg);
break;
case 6:
// 0.5 us pro Stufe, Register 0 = 0.5 us
if(value < 0.5f || value > 64){
return 1;
}
reg = (int)(value * 2) - 1;
result = L6474_SetProperty(s, L6474_PROP_TON, reg);
break;
case 7:
// 2 us pro Stufe, Register 0 = 2 us
// obere 4 Bit: TOFF_FAST (wird gesetzt), untere 4 Bit: FAST_STEP (bleibt)
if(value < 2 || value > 32){
return 1;
}
L6474_GetProperty(s, L6474_PROP_TFAST, &reg);
reg = (((int)(value / 2) - 1) << 4) | (reg & 0x0F);
result = L6474_SetProperty(s, L6474_PROP_TFAST, reg);
break;
case 8:
if(value <= 0){
return 1;
}
mmperturn = value;
result = errcNONE;
break;
case 9:
posmax = value;
result = errcNONE;
break;
case 10:
posmin = value;
result = errcNONE;
break;
case 11:
posref = value;
result = errcNONE;
break;
case 12:
if(value < 1){
return 1;
}
stepsperturn = (int)value;
result = errcNONE;
break;
default:
return 1;
}
if(result != errcNONE){
return 1;
}
return 0;
}
static int config_stepper_get(L6474_Handle_t s, int param, float* value){
//gleiche param Nummern und Einheiten wie bei config_stepper
int reg = 0;
int result = 0;
L6474x_State_t driverState;
L6474x_StepMode_t mode;
switch(param){
case 1:
result = L6474_GetProperty(s, L6474_PROP_TORQUE, &reg);
*value = (reg + 1) * 31.25f;
break;
case 2:
result = L6474_GetProperty(s, L6474_PROP_OCDTH, &reg);
*value = (reg + 1) * 375;
break;
case 3:
result = L6474_GetState(s, &driverState);
if(driverState == stENABLED){
*value = 1;
}else{
*value = 0;
}
break;
case 4:
result = L6474_GetStepMode(s, &mode);
if(mode == smFULL){
*value = 1;
}else if(mode == smHALF){
*value = 2;
}else if(mode == smMICRO4){
*value = 4;
}else if(mode == smMICRO8){
*value = 8;
}else{
*value = 16;
}
break;
case 5:
result = L6474_GetProperty(s, L6474_PROP_TOFF, &reg);
*value = (reg + 1) * 0.5f;
break;
case 6:
result = L6474_GetProperty(s, L6474_PROP_TON, &reg);
*value = (reg + 1) * 0.5f;
break;
case 7:
result = L6474_GetProperty(s, L6474_PROP_TFAST, &reg);
*value = ((reg >> 4) + 1) * 2;
break;
case 8:
*value = mmperturn;
result = errcNONE;
break;
case 9:
*value = posmax;
result = errcNONE;
break;
case 10:
*value = posmin;
result = errcNONE;
break;
case 11:
*value = posref;
result = errcNONE;
break;
case 12:
*value = stepsperturn;
result = errcNONE;
break;
default:
return 1;
}
if(result != errcNONE){
return 1;
}
return 0;
}
static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){ static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){
(void)pPWM; (void)pPWM;
@@ -57,17 +369,31 @@ static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){
HAL_GPIO_WritePin(STEP_DIR_GPIO_Port, STEP_DIR_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(STEP_DIR_GPIO_Port, STEP_DIR_Pin, GPIO_PIN_RESET);
} }
for(unsigned int i = 0; i < numPulses; i++){ (void)xSemaphoreTake(stepDone, 0); // altes Signal verwerfen
HAL_GPIO_WritePin(STEP_PULSE_GPIO_Port, STEP_PULSE_Pin, GPIO_PIN_SET);
vTaskDelay(pdMS_TO_TICKS(1)); stepsLeft = numPulses;
HAL_GPIO_WritePin(STEP_PULSE_GPIO_Port, STEP_PULSE_Pin, GPIO_PIN_RESET); StepTimerStartChunk();
vTaskDelay(pdMS_TO_TICKS(1));
// Erwartete Fahrzeit plus 1 s Reserve
uint32_t timeoutMs = (uint32_t)(((uint64_t)numPulses * 1000u) / stepHz) + 1000u;
TickType_t start = xTaskGetTickCount();
// Bei Fehler oder Timeout Pulse sofort stoppen
while(xSemaphoreTake(stepDone, pdMS_TO_TICKS(STEP_POLL_MS)) != pdTRUE){
if(StepperHasFault(stepperHandle) || (xTaskGetTickCount() - start) >= pdMS_TO_TICKS(timeoutMs)){
stepsLeft = 0; // zuerst, damit der Interrupt keinen neuen Chunk startet
TIM1->CR1 &= ~TIM_CR1_CEN;
return 1;
}
} }
return 0; return 0;
} }
int cancel_stepper(){
TIM1->CR1 &= ~TIM_CR1_CEN;
return 0;
}
L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){ L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){
@@ -76,8 +402,11 @@ L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){
(void)pGPO; (void)pGPO;
(void)pPWM; (void)pPWM;
stepDone = xSemaphoreCreateBinary();
StepTimerSetSpeed(STEP_HZ_MOVE);
TIM1->SR = ~TIM_SR_CC1IF; // sonst feuert der Interrupt sofort beim Freischalten
__HAL_TIM_ENABLE_IT(&htim1, TIM_IT_CC1);
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4); // laeuft erst bei offenem Gate
static L6474x_Platform_t p; static L6474x_Platform_t p;
p.malloc = StepLibraryMalloc; p.malloc = StepLibraryMalloc;
@@ -90,27 +419,17 @@ L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){
//p.stepAsync = StepTimerAsync; //p.stepAsync = StepTimerAsync;
//p.cancelStep = StepTimerCancelAsync; //p.cancelStep = StepTimerCancelAsync;
L6474_Handle_t s = L6474_CreateInstance(&p, pIO, pGPO, pPWM); L6474_Handle_t s = L6474_CreateInstance(&p, pIO, pGPO, pPWM);
stepperHandle = s;
return s; return s;
} }
static int stepper_check_status(L6474_Handle_t s){
L6474_Status_t st;
if(L6474_GetStatus(s, &st) != errcNONE){
return 1;
}
if(st.UVLO || st.TH_SD || st.OCD || st.NOTPERF_CMD || st.WRONG_CMD){
return 1;
}
return 0;
}
int reset_stepper(L6474_Handle_t s){ int reset_stepper(L6474_Handle_t s){
L6474_BaseParameter_t b; L6474_BaseParameter_t b;
L6474_SetBaseParameter(&b); L6474_SetBaseParameter(&b);
b.stepMode = smMICRO16; b.stepMode = smMICRO16;
microsteps = 16;
b.OcdTh = ocdth1125mA; b.OcdTh = ocdth1125mA;
L6474_EncodePhaseCurrentParameter(&b, 700.0f); L6474_EncodePhaseCurrentParameter(&b, 700.0f);
@@ -121,50 +440,60 @@ int reset_stepper(L6474_Handle_t s){
result |= L6474_Initialize(s, &b); result |= L6474_Initialize(s, &b);
result |= L6474_SetPowerOutputs(s, 0); result |= L6474_SetPowerOutputs(s, 0);
yellow_led_stop(); yellow_led_stop();
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_RESET);
return result; return result;
} }
#define REF_MAX_STEPS (mm_to_step(150))
int stepper_reference(L6474_Handle_t s, int flag){ int stepper_reference(L6474_Handle_t s, int flag){
if(L6474_SetPowerOutputs(s, 1) != errcNONE){ if(L6474_SetPowerOutputs(s, 1) != errcNONE){
return 1; return 1;
} }
yellow_led_start(); yellow_led_start();
//flag: 0 keiner, 1 -t, 2 -e, 3 -s //flag: 0 keiner, 1 -t, 2 -e, 3 -s
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
if(L6474_StepIncremental(s, mm_to_step(5)) != errcNONE){ if(L6474_StepIncremental(s, mm_to_step(5)) != errcNONE){
return 1; return 1;
} }
if(stepper_check_status(s)){
return 1;
}
}
// zum Schalter fahren, mit Limit und Statuspruefung int button_pressed = 0;
int steps = 0;
while(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) != GPIO_PIN_RESET){ while(!button_pressed){
if(L6474_StepIncremental(s, -1) != errcNONE){ if(L6474_StepIncremental(s, -1) != errcNONE){
return 1; return 1;
}
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
button_pressed=1;
} }
if((++steps % 100) == 0 && stepper_check_status(s)){
return 1;
}
if(steps > REF_MAX_STEPS){
return 1; // Schalter nie erreicht
} }
}
if(flag == 3){
L6474_SetAbsolutePosition(s, 0);
return StepperHasFault(s);
}
int button_pressed = 0;
while(!button_pressed){
if(L6474_StepIncremental(s, -1) != errcNONE){
return 1;
}
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
button_pressed=1;
} }
if(stepper_check_status(s)){
return 1;
} }
if(L6474_SetAbsolutePosition(s, 0) != errcNONE){ L6474_SetAbsolutePosition(s, mm_to_step(posref));
return 1;
} return StepperHasFault(s);
return 0;
} }
void stepper_softstart(L6474_Handle_t s, unsigned int duration){ void stepper_softstart(L6474_Handle_t s, unsigned int duration){
@@ -176,8 +505,8 @@ int stepper_pos(L6474_Handle_t s){
if(L6474_GetAbsolutePosition(s, &position) != errcNONE){ if(L6474_GetAbsolutePosition(s, &position) != errcNONE){
return 1; return 1;
} }
printf("%d", (position/800)); printf("%d", (int)(position * mmperturn / (stepsperturn * microsteps)));
return 0; return StepperHasFault(s);
} }
int stepper_status(L6474_Handle_t s){ int stepper_status(L6474_Handle_t s){
@@ -196,15 +525,11 @@ int stepper_move(L6474_Handle_t s, int pos){
int pos_diff = pos - position; int pos_diff = pos - position;
if(L6474_StepIncremental(s, pos_diff) != errcNONE){ if(pos_diff != 0 && L6474_StepIncremental(s, pos_diff) != errcNONE){
return 1; return 1;
} }
if(stepper_check_status(s)){ return StepperHasFault(s);
return 1;
}
return 0;
} }
static void print_binary_8bit(unsigned int val) { static void print_binary_8bit(unsigned int val) {
@@ -217,17 +542,14 @@ static void print_binary_8bit(unsigned int val) {
} }
int StepperConsoleFunction( int argc, char** argv, void* ctx ) int StepperConsoleFunction( int argc, char** argv, void* ctx )
// --------------------------------------------------------------------------------------------------------------------
{ {
//possible commands are
//(stepper) step 100
(void)argc; (void)argc;
(void)argv; (void)argv;
(void)ctx; (void)ctx;
L6474_Handle_t h = (L6474_Handle_t)ctx; L6474_Handle_t h = (L6474_Handle_t)ctx;
// first decode the subcommand and all arguments
if ( argc == 0 ) if ( argc == 0 )
{ {
printf("invalid number of arguments\r\n"); printf("invalid number of arguments\r\n");
@@ -243,36 +565,35 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
} }
if ( argc < 2 ) if ( argc < 2 )
{ {
printf("missing step value for step command\r\n"); printf("missing step value for step commandFAIL\r\n");
printf("FAIL\r\n");
return -1; return -1;
} }
if(L6474_StepIncremental(h, atoi(argv[1])) != errcNONE || stepper_check_status(h)){ int steps = atoi(argv[1]);
if((steps != 0 && L6474_StepIncremental(h, steps) != errcNONE) || StepperHasFault(h)){
state = 0; state = 0;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
yellow_led_stop();
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
} }
printf("%d steps", (int)atoi(argv[1])); printf("%d steps", steps);
} }
else if ( strcmp(argv[0], "reset") == 0 ) else if ( strcmp(argv[0], "reset") == 0 )
{ {
if(reset_stepper(h)){ if(reset_stepper(h)){
state = 0; state = 0;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
yellow_led_stop(); yellow_led_stop();
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
} }
state = 1; state = 1;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_SET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_SET);
printf("OK\r\n"); printf("OK\r\n");
return 0; return 0;
@@ -285,10 +606,14 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
return -1; return -1;
} }
if(stepper_reference(h, 0)){ StepTimerSetSpeed(STEP_HZ_REFERENCE);
int refResult = stepper_reference(h, 0);
StepTimerSetSpeed(STEP_HZ_MOVE);
if(refResult){
state = 0; state = 0;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
yellow_led_stop(); yellow_led_stop();
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
@@ -308,14 +633,14 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
if(stepper_pos(h)){ if(stepper_pos(h)){
state = 0; state = 0;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
yellow_led_stop(); yellow_led_stop();
printf("\r\nFAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
} }
printf("\r\nOK\r\n"); printf("OK\r\n");
return 0; return 0;
} }
else if ( strcmp(argv[0], "move") == 0 ) else if ( strcmp(argv[0], "move") == 0 )
@@ -332,9 +657,28 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
} }
float target_mm = (float)atof(argv[1]); float target_mm = (float)atof(argv[1]);
if (target_mm < 0.0f || target_mm > 100.0f) { if ( argc > 2)
{
if(strcmp(argv[2], "-s")==0){
//TODO: Geschwindigkeit verstellen
unsigned int hz = atoi(argv[3]) * 800 / 60;
StepTimerSetSpeed(hz);
}
else if(strcmp(argv[2], "-r")==0){
int temp = 0;
L6474_GetAbsolutePosition(h, &temp);
target_mm = (float)temp * mmperturn / (stepsperturn * microsteps) + (float)atof(argv[1]);
}
else if(strcmp(argv[2], "-a")==0){
}
}
if (target_mm < posmin || target_mm > posmax) {
printf("position out of range\r\n"); printf("position out of range\r\n");
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
@@ -342,8 +686,8 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
if(stepper_move(h, mm_to_step(target_mm))==1){ if(stepper_move(h, mm_to_step(target_mm))==1){
state = 0; state = 0;
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
yellow_led_stop(); yellow_led_stop();
printf("FAIL\r\n"); printf("FAIL\r\n");
return -1; return -1;
@@ -352,50 +696,132 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
return 0; return 0;
} }
else if (strcmp(argv[0], "status") == 0) else if (strcmp(argv[0], "status") == 0)
{ {
L6474x_State_t currentState; L6474x_State_t currentState;
L6474_Status_t stepperStatus; L6474_Status_t stepperStatus;
int moving = 0; int moving = 0;
// 1. get state of state machine // 1. get state of state machine
if (L6474_GetState(h, &currentState) != errcNONE) if (L6474_GetState(h, &currentState) != errcNONE)
{ {
printf("failed to get state\r\nFAIL"); printf("failed to get state\r\nFAIL");
return -1; return -1;
} }
// 2.get driver-state // 2.get driver-state
if (L6474_GetStatus(h, &stepperStatus) != errcNONE) if (L6474_GetStatus(h, &stepperStatus) != errcNONE)
{ {
printf("failed to get status\r\nFAIL"); printf("failed to get status\r\nFAIL");
return -1; return -1;
} }
unsigned int errorBits = ((stepperStatus.WRONG_CMD & 0x01) << 8) | unsigned int errorBits = ((stepperStatus.WRONG_CMD & 0x01) << 8) |
((stepperStatus.UVLO & 0x01) << 7) | ((stepperStatus.UVLO & 0x01) << 7) |
((stepperStatus.TH_WARN & 0x01) << 6) | ((stepperStatus.TH_WARN & 0x01) << 6) |
((stepperStatus.TH_SD & 0x01) << 5) | ((stepperStatus.TH_SD & 0x01) << 5) |
((stepperStatus.ONGOING & 0x01) << 4) | ((stepperStatus.ONGOING & 0x01) << 4) |
((stepperStatus.OCD & 0x01) << 3) | ((stepperStatus.OCD & 0x01) << 3) |
((stepperStatus.NOTPERF_CMD & 0x01) << 2) | ((stepperStatus.NOTPERF_CMD & 0x01) << 2) |
((stepperStatus.HIGHZ & 0x01) << 1) | ((stepperStatus.HIGHZ & 0x01) << 1) |
((stepperStatus.DIR & 0x01) << 0); ((stepperStatus.DIR & 0x01) << 0);
// 3. check for moving motor aka async pending operation (should be always 0 with no async mode) // 3. check for moving motor aka async pending operation (should be always 0 with no async mode)
L6474_IsMoving(h, &moving); L6474_IsMoving(h, &moving);
printf("0x%X\r\n", (unsigned int)currentState); //print state in first line //TEST CODE START
printf("0x%X\r\n", errorBits); //print error flags in second line
printf("internal error bits in binary: "); unsigned int mappedState = 0x0;
print_binary_8bit(errorBits);
printf("%d\r\n", moving); //print async pending op in third line // check for error (would print 0x8)
printf("OK"); if (errorBits != 0) {
mappedState = 0x8; // scsFLT
}
else {
switch (currentState) {
case stRESET:
mappedState = 0x1; //map stRESET to scsREF?
break;
case stDISABLED:
mappedState = 0x2; //map stDISABLED to scsDIS (driver ready, otuput off)?
break;
case stENABLED:
mappedState = 0x4; //map stENABLED to scsENA --> driver active + output on
break;
default:
mappedState = 0x0; //entsprciht scsInit
break;
}
}
printf("0x%X\r\n", mappedState); //print state machine state in first line
//TEST CODE END
//printf("0x%X\r\n", (unsigned int)currentState); //print state in first line
printf("0x%X\r\n", errorBits); //print error flags in second line
printf("internal error bits in binary: ");
print_binary_8bit(errorBits);
printf("%d\r\n", moving); //print async pending op in third line
printf("OK");
return 0;
}
else if (strcmp(argv[0], "config") == 0)
{
if ( argc < 2 ){
printf("missing parameter name for config command\r\n");
printf("FAIL\r\n");
return -1;
}
int param = config_param_id(argv[1]);
if(param == 0){
printf("unknown config parameter\r\n");
printf("FAIL\r\n");
return -1;
}
// Ohne Flag: Wert lesen -> config <param>
if ( argc == 2 ){
float value = 0.0f;
if(config_stepper_get(h, param, &value) != 0){
printf("FAIL\r\n");
return -1;
}
printf("%.2f\r\n", value);
printf("OK\r\n");
return 0;
}
// Mit Flag: Wert schreiben -> config <param> -v <value>
if ( argc >= 4 && strcmp(argv[2], "-v") == 0 ){
float value = (float)atof(argv[3]);
if(config_stepper(h, param, value) != 0){
printf("FAIL\r\n");
return -1;
}
printf("OK\r\n");
return 0;
}
printf("usage: config <param> [-v <value>]\r\n");
printf("FAIL\r\n");
return -1;
}
return 0;
}
else else
{ {
printf("passed invalid sub command\r\n"); printf("passed invalid sub command\r\n");
+178 -31
View File
@@ -59,7 +59,14 @@
SPI_HandleTypeDef hspi1; SPI_HandleTypeDef hspi1;
TIM_HandleTypeDef htim1;
TIM_HandleTypeDef htim2; TIM_HandleTypeDef htim2;
TIM_HandleTypeDef htim4;
//Für LEDS
TIM_HandleTypeDef htim3;
TIM_HandleTypeDef htim12;
UART_HandleTypeDef huart3; UART_HandleTypeDef huart3;
@@ -75,6 +82,8 @@ static void MX_GPIO_Init(void);
static void MX_SPI1_Init(void); static void MX_SPI1_Init(void);
static void MX_TIM2_Init(void); static void MX_TIM2_Init(void);
static void MX_USART3_UART_Init(void); static void MX_USART3_UART_Init(void);
static void MX_TIM1_Init(void);
static void MX_TIM4_Init(void);
/* USER CODE BEGIN PFP */ /* USER CODE BEGIN PFP */
extern void initialise_stdlib_abstraction( void ); extern void initialise_stdlib_abstraction( void );
@@ -118,34 +127,35 @@ void green_led(){
static TaskHandle_t yellowLedTask = NULL; static TaskHandle_t yellowLedTask = NULL;
void blink_yellow_led(){ void blink_yellow_led(){
while(1){ while(1){
HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_SET); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_SET);
vTaskDelay(pdMS_TO_TICKS(500)); vTaskDelay(pdMS_TO_TICKS(500));
HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET);
vTaskDelay(pdMS_TO_TICKS(500)); vTaskDelay(pdMS_TO_TICKS(500));
} }
} }
void yellow_led_start(void) void yellow_led_start(void)
{ {
if (yellowLedTask == NULL) { if (yellowLedTask == NULL) {
xTaskCreate(blink_yellow_led, "blink_yellow_led", 1024, NULL, 1, &yellowLedTask); xTaskCreate(blink_yellow_led, "blink_yellow_led", 1024, NULL, 1, &yellowLedTask);
} }
} }
void yellow_led_stop(void) void yellow_led_stop(void)
{ {
if (yellowLedTask != NULL) { if (yellowLedTask != NULL) {
vTaskDelete(yellowLedTask); vTaskDelete(yellowLedTask);
yellowLedTask = NULL; yellowLedTask = NULL;
HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET);
} }
} }
void red_led(){ void red_led(){
while(1){ while(1){
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_14, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOE, GPIO_PIN_1, GPIO_PIN_RESET);
@@ -153,6 +163,7 @@ void red_led(){
} }
// -------------------------------------------------------------------------------------------------------------------- // --------------------------------------------------------------------------------------------------------------------
static int CapabilityFunc( int argc, char** argv, void* ctx ) static int CapabilityFunc( int argc, char** argv, void* ctx )
// -------------------------------------------------------------------------------------------------------------------- // --------------------------------------------------------------------------------------------------------------------
@@ -164,8 +175,8 @@ static int CapabilityFunc( int argc, char** argv, void* ctx )
1, // has spindle 1, // has spindle
1, // has spindle status 1, // has spindle status
1, // has stepper 1, // has stepper
0, // has stepper move relative 1, // has stepper move relative
0, // has stepper move speed 1, // has stepper move speed
0, // has stepper move async 0, // has stepper move async
1, // has stepper status 1, // has stepper status
1, // has stepper refrun 1, // has stepper refrun
@@ -174,18 +185,18 @@ static int CapabilityFunc( int argc, char** argv, void* ctx )
0, // has stepper refrun stay enabled 0, // has stepper refrun stay enabled
1, // has stepper reset 1, // has stepper reset
1, // has stepper position 1, // has stepper position
0, // has stepper config 1, // has stepper config
0, // has stepper config torque 2, // has stepper config torque
0, // has stepper config throvercurr 1, // has stepper config throvercurr
0, // has stepper config powerena 1, // has stepper config powerena
0, // has stepper config stepmode 1, // has stepper config stepmode
0, // has stepper config timeoff 1, // has stepper config timeoff
0, // has stepper config timeon 1, // has stepper config timeon
0, // has stepper config timefast 1, // has stepper config timefast
0, // has stepper config mmperturn 0, // has stepper config mmperturn
0, // has stepper config posmax 1, // has stepper config posmax
0, // has stepper config posmin 1, // has stepper config posmin
0, // has stepper config posref 1, // has stepper config posref
0, // has stepper config stepsperturn 0, // has stepper config stepsperturn
0 // has stepper cancel 0 // has stepper cancel
); );
@@ -319,6 +330,8 @@ int main(void)
MX_SPI1_Init(); MX_SPI1_Init();
MX_TIM2_Init(); MX_TIM2_Init();
MX_USART3_UART_Init(); MX_USART3_UART_Init();
MX_TIM1_Init();
MX_TIM4_Init();
/* USER CODE BEGIN 2 */ /* USER CODE BEGIN 2 */
// cretae a free rtos queue to buffer console characters received from debug uart // cretae a free rtos queue to buffer console characters received from debug uart
@@ -540,6 +553,140 @@ static void MX_TIM2_Init(void)
} }
/**
* @brief TIM1 Initialization Function
* @param None
* @retval None
*/
static void MX_TIM1_Init(void)
{
/* USER CODE BEGIN TIM1_Init 0 */
/* USER CODE END TIM1_Init 0 */
TIM_SlaveConfigTypeDef sSlaveConfig = {0};
TIM_MasterConfigTypeDef sMasterConfig = {0};
TIM_OC_InitTypeDef sConfigOC = {0};
/* USER CODE BEGIN TIM1_Init 1 */
/* USER CODE END TIM1_Init 1 */
htim1.Instance = TIM1;
htim1.Init.Prescaler = 0;
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
htim1.Init.Period = 65535;
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
htim1.Init.RepetitionCounter = 0;
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
{
Error_Handler();
}
if (HAL_TIM_OC_Init(&htim1) != HAL_OK)
{
Error_Handler();
}
if (HAL_TIM_OnePulse_Init(&htim1, TIM_OPMODE_SINGLE) != HAL_OK)
{
Error_Handler();
}
sSlaveConfig.SlaveMode = TIM_SLAVEMODE_EXTERNAL1;
sSlaveConfig.InputTrigger = TIM_TS_ITR3;
if (HAL_TIM_SlaveConfigSynchro(&htim1, &sSlaveConfig) != HAL_OK)
{
Error_Handler();
}
sMasterConfig.MasterOutputTrigger = TIM_TRGO_ENABLE;
sMasterConfig.MasterOutputTrigger2 = TIM_TRGO2_ENABLE;
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
{
Error_Handler();
}
sConfigOC.OCMode = TIM_OCMODE_TIMING;
sConfigOC.Pulse = 0;
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
if (HAL_TIM_OC_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
{
Error_Handler();
}
/* USER CODE BEGIN TIM1_Init 2 */
/* USER CODE END TIM1_Init 2 */
}
/**
* @brief TIM4 Initialization Function
* @param None
* @retval None
*/
static void MX_TIM4_Init(void)
{
/* USER CODE BEGIN TIM4_Init 0 */
/* USER CODE END TIM4_Init 0 */
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
TIM_SlaveConfigTypeDef sSlaveConfig = {0};
TIM_MasterConfigTypeDef sMasterConfig = {0};
TIM_OC_InitTypeDef sConfigOC = {0};
/* USER CODE BEGIN TIM4_Init 1 */
/* USER CODE END TIM4_Init 1 */
htim4.Instance = TIM4;
htim4.Init.Prescaler = 127;
htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
htim4.Init.Period = 5624;
htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE;
if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
{
Error_Handler();
}
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
{
Error_Handler();
}
if (HAL_TIM_PWM_Init(&htim4) != HAL_OK)
{
Error_Handler();
}
sSlaveConfig.SlaveMode = TIM_SLAVEMODE_GATED;
sSlaveConfig.InputTrigger = TIM_TS_ITR0;
if (HAL_TIM_SlaveConfigSynchro(&htim4, &sSlaveConfig) != HAL_OK)
{
Error_Handler();
}
sMasterConfig.MasterOutputTrigger = TIM_TRGO_UPDATE;
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
{
Error_Handler();
}
sConfigOC.OCMode = TIM_OCMODE_PWM2;
sConfigOC.Pulse = 2812;
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
if (HAL_TIM_PWM_ConfigChannel(&htim4, &sConfigOC, TIM_CHANNEL_4) != HAL_OK)
{
Error_Handler();
}
/* USER CODE BEGIN TIM4_Init 2 */
/* USER CODE END TIM4_Init 2 */
HAL_TIM_MspPostInit(&htim4);
}
/** /**
* @brief USART3 Initialization Function * @brief USART3 Initialization Function
* @param None * @param None
@@ -614,7 +761,7 @@ static void MX_GPIO_Init(void)
HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin|LED_RED_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin|LED_RED_Pin, GPIO_PIN_RESET);
/*Configure GPIO pin Output Level */ /*Configure GPIO pin Output Level */
HAL_GPIO_WritePin(GPIOD, STEP_SPI_CS_Pin|STEP_PULSE_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(STEP_SPI_CS_GPIO_Port, STEP_SPI_CS_Pin, GPIO_PIN_RESET);
/*Configure GPIO pin Output Level */ /*Configure GPIO pin Output Level */
HAL_GPIO_WritePin(GPIOG, STEP_RSTN_Pin|STEP_DIR_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(GPIOG, STEP_RSTN_Pin|STEP_DIR_Pin, GPIO_PIN_RESET);
@@ -645,12 +792,12 @@ static void MX_GPIO_Init(void)
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
/*Configure GPIO pins : STEP_SPI_CS_Pin STEP_PULSE_Pin */ /*Configure GPIO pin : STEP_SPI_CS_Pin */
GPIO_InitStruct.Pin = STEP_SPI_CS_Pin|STEP_PULSE_Pin; GPIO_InitStruct.Pin = STEP_SPI_CS_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
GPIO_InitStruct.Pull = GPIO_NOPULL; GPIO_InitStruct.Pull = GPIO_NOPULL;
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
HAL_GPIO_Init(GPIOD, &GPIO_InitStruct); HAL_GPIO_Init(STEP_SPI_CS_GPIO_Port, &GPIO_InitStruct);
/*Configure GPIO pins : STEP_RSTN_Pin STEP_DIR_Pin */ /*Configure GPIO pins : STEP_RSTN_Pin STEP_DIR_Pin */
GPIO_InitStruct.Pin = STEP_RSTN_Pin|STEP_DIR_Pin; GPIO_InitStruct.Pin = STEP_RSTN_Pin|STEP_DIR_Pin;
@@ -182,7 +182,23 @@ void HAL_SPI_MspDeInit(SPI_HandleTypeDef* hspi)
*/ */
void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* htim_base) void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* htim_base)
{ {
if(htim_base->Instance==TIM2) if(htim_base->Instance==TIM1)
{
/* USER CODE BEGIN TIM1_MspInit 0 */
/* USER CODE END TIM1_MspInit 0 */
/* Peripheral clock enable */
__HAL_RCC_TIM1_CLK_ENABLE();
/* TIM1 interrupt Init */
HAL_NVIC_SetPriority(TIM1_UP_IRQn, 5, 0);
HAL_NVIC_EnableIRQ(TIM1_UP_IRQn);
HAL_NVIC_SetPriority(TIM1_CC_IRQn, 5, 0);
HAL_NVIC_EnableIRQ(TIM1_CC_IRQn);
/* USER CODE BEGIN TIM1_MspInit 1 */
/* USER CODE END TIM1_MspInit 1 */
}
else if(htim_base->Instance==TIM2)
{ {
/* USER CODE BEGIN TIM2_MspInit 0 */ /* USER CODE BEGIN TIM2_MspInit 0 */
@@ -192,7 +208,20 @@ void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* htim_base)
/* USER CODE BEGIN TIM2_MspInit 1 */ /* USER CODE BEGIN TIM2_MspInit 1 */
/* USER CODE END TIM2_MspInit 1 */ /* USER CODE END TIM2_MspInit 1 */
}
else if(htim_base->Instance==TIM4)
{
/* USER CODE BEGIN TIM4_MspInit 0 */
/* USER CODE END TIM4_MspInit 0 */
/* Peripheral clock enable */
__HAL_RCC_TIM4_CLK_ENABLE();
/* TIM4 interrupt Init */
HAL_NVIC_SetPriority(TIM4_IRQn, 5, 0);
HAL_NVIC_EnableIRQ(TIM4_IRQn);
/* USER CODE BEGIN TIM4_MspInit 1 */
/* USER CODE END TIM4_MspInit 1 */
} }
} }
@@ -222,6 +251,27 @@ void HAL_TIM_MspPostInit(TIM_HandleTypeDef* htim)
/* USER CODE END TIM2_MspPostInit 1 */ /* USER CODE END TIM2_MspPostInit 1 */
} }
else if(htim->Instance==TIM4)
{
/* USER CODE BEGIN TIM4_MspPostInit 0 */
/* USER CODE END TIM4_MspPostInit 0 */
__HAL_RCC_GPIOD_CLK_ENABLE();
/**TIM4 GPIO Configuration
PD15 ------> TIM4_CH4
*/
GPIO_InitStruct.Pin = STEP_PULSE_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
GPIO_InitStruct.Pull = GPIO_NOPULL;
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
GPIO_InitStruct.Alternate = GPIO_AF2_TIM4;
HAL_GPIO_Init(STEP_PULSE_GPIO_Port, &GPIO_InitStruct);
/* USER CODE BEGIN TIM4_MspPostInit 1 */
/* USER CODE END TIM4_MspPostInit 1 */
}
} }
/** /**
@@ -232,7 +282,22 @@ void HAL_TIM_MspPostInit(TIM_HandleTypeDef* htim)
*/ */
void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* htim_base) void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* htim_base)
{ {
if(htim_base->Instance==TIM2) if(htim_base->Instance==TIM1)
{
/* USER CODE BEGIN TIM1_MspDeInit 0 */
/* USER CODE END TIM1_MspDeInit 0 */
/* Peripheral clock disable */
__HAL_RCC_TIM1_CLK_DISABLE();
/* TIM1 interrupt DeInit */
HAL_NVIC_DisableIRQ(TIM1_UP_IRQn);
HAL_NVIC_DisableIRQ(TIM1_CC_IRQn);
/* USER CODE BEGIN TIM1_MspDeInit 1 */
/* USER CODE END TIM1_MspDeInit 1 */
}
else if(htim_base->Instance==TIM2)
{ {
/* USER CODE BEGIN TIM2_MspDeInit 0 */ /* USER CODE BEGIN TIM2_MspDeInit 0 */
@@ -243,6 +308,20 @@ void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* htim_base)
/* USER CODE END TIM2_MspDeInit 1 */ /* USER CODE END TIM2_MspDeInit 1 */
} }
else if(htim_base->Instance==TIM4)
{
/* USER CODE BEGIN TIM4_MspDeInit 0 */
/* USER CODE END TIM4_MspDeInit 0 */
/* Peripheral clock disable */
__HAL_RCC_TIM4_CLK_DISABLE();
/* TIM4 interrupt DeInit */
HAL_NVIC_DisableIRQ(TIM4_IRQn);
/* USER CODE BEGIN TIM4_MspDeInit 1 */
/* USER CODE END TIM4_MspDeInit 1 */
}
} }
@@ -55,6 +55,8 @@
/* USER CODE END 0 */ /* USER CODE END 0 */
/* External variables --------------------------------------------------------*/ /* External variables --------------------------------------------------------*/
extern TIM_HandleTypeDef htim1;
extern TIM_HandleTypeDef htim4;
extern UART_HandleTypeDef huart3; extern UART_HandleTypeDef huart3;
/* USER CODE BEGIN EV */ /* USER CODE BEGIN EV */
@@ -210,6 +212,48 @@ void SysTick_Handler(void)
/* please refer to the startup file (startup_stm32h7xx.s). */ /* please refer to the startup file (startup_stm32h7xx.s). */
/******************************************************************************/ /******************************************************************************/
/**
* @brief This function handles TIM1 update interrupt.
*/
void TIM1_UP_IRQHandler(void)
{
/* USER CODE BEGIN TIM1_UP_IRQn 0 */
/* USER CODE END TIM1_UP_IRQn 0 */
HAL_TIM_IRQHandler(&htim1);
/* USER CODE BEGIN TIM1_UP_IRQn 1 */
/* USER CODE END TIM1_UP_IRQn 1 */
}
/**
* @brief This function handles TIM1 capture compare interrupt.
*/
void TIM1_CC_IRQHandler(void)
{
/* USER CODE BEGIN TIM1_CC_IRQn 0 */
/* USER CODE END TIM1_CC_IRQn 0 */
HAL_TIM_IRQHandler(&htim1);
/* USER CODE BEGIN TIM1_CC_IRQn 1 */
/* USER CODE END TIM1_CC_IRQn 1 */
}
/**
* @brief This function handles TIM4 global interrupt.
*/
void TIM4_IRQHandler(void)
{
/* USER CODE BEGIN TIM4_IRQn 0 */
/* USER CODE END TIM4_IRQn 0 */
HAL_TIM_IRQHandler(&htim4);
/* USER CODE BEGIN TIM4_IRQn 1 */
/* USER CODE END TIM4_IRQn 1 */
}
/** /**
* @brief This function handles USART3 global interrupt. * @brief This function handles USART3 global interrupt.
*/ */
+3 -2
View File
@@ -445,7 +445,7 @@ SPI1.VirtualType=VM_MASTER
SYS.userName=SYS_M7 SYS.userName=SYS_M7
TIM1.Channel-Output\ Compare1\ No\ Output=TIM_CHANNEL_1 TIM1.Channel-Output\ Compare1\ No\ Output=TIM_CHANNEL_1
TIM1.IPParameters=Channel-Output Compare1 No Output,Period,TIM_MasterOutputTrigger,TIM_MasterOutputTrigger2 TIM1.IPParameters=Channel-Output Compare1 No Output,Period,TIM_MasterOutputTrigger,TIM_MasterOutputTrigger2
TIM1.Period=8191 TIM1.Period=65535
TIM1.TIM_MasterOutputTrigger=TIM_TRGO_ENABLE TIM1.TIM_MasterOutputTrigger=TIM_TRGO_ENABLE
TIM1.TIM_MasterOutputTrigger2=TIM_TRGO2_ENABLE TIM1.TIM_MasterOutputTrigger2=TIM_TRGO2_ENABLE
TIM2.Channel-PWM\ Generation3\ CH3=TIM_CHANNEL_3 TIM2.Channel-PWM\ Generation3\ CH3=TIM_CHANNEL_3
@@ -454,7 +454,8 @@ TIM2.IPParameters=Channel-PWM Generation3 CH3,Channel-PWM Generation4 CH4,Period
TIM2.Period=9999 TIM2.Period=9999
TIM4.AutoReloadPreload=TIM_AUTORELOAD_PRELOAD_ENABLE TIM4.AutoReloadPreload=TIM_AUTORELOAD_PRELOAD_ENABLE
TIM4.Channel-PWM\ Generation4\ CH4=TIM_CHANNEL_4 TIM4.Channel-PWM\ Generation4\ CH4=TIM_CHANNEL_4
TIM4.IPParameters=Channel-PWM Generation4 CH4,Prescaler,Period,AutoReloadPreload,TIM_MasterOutputTrigger,Pulse-PWM Generation4 CH4 TIM4.IPParameters=Channel-PWM Generation4 CH4,Prescaler,Period,AutoReloadPreload,TIM_MasterOutputTrigger,Pulse-PWM Generation4 CH4,OCMode_PWM-PWM Generation4 CH4
TIM4.OCMode_PWM-PWM\ Generation4\ CH4=TIM_OCMODE_PWM2
TIM4.Period=5624 TIM4.Period=5624
TIM4.Prescaler=127 TIM4.Prescaler=127
TIM4.Pulse-PWM\ Generation4\ CH4=2812 TIM4.Pulse-PWM\ Generation4\ CH4=2812