From 634b69a55c965e02cd293831a4463de40fd87d2c Mon Sep 17 00:00:00 2001 From: FewiKay Date: Mon, 19 Oct 2026 16:59:42 +0200 Subject: [PATCH] stepper; doesnt work --- stm32-stepper-root/stepper_h7/CM7/.project | 11 +--- .../stepper_h7/CM7/Core/Inc/Spindle/spindel.h | 1 + .../stepper_h7/CM7/Core/Inc/Stepper/stepper.h | 13 ++-- .../stepper_h7/CM7/Core/Inc/main.h | 1 + .../stepper_h7/CM7/Core/Src/Stepper/stepper.c | 59 ++++++++++++++++++- .../stepper_h7/CM7/Core/Src/main.c | 3 + .../stepper_h7/CM7/Core/Src/stm32h7xx_it.c | 2 +- 7 files changed, 74 insertions(+), 16 deletions(-) diff --git a/stm32-stepper-root/stepper_h7/CM7/.project b/stm32-stepper-root/stepper_h7/CM7/.project index 718c0fa..3c7c458 100644 --- a/stm32-stepper-root/stepper_h7/CM7/.project +++ b/stm32-stepper-root/stepper_h7/CM7/.project @@ -195,9 +195,9 @@ PARENT-2-PROJECT_LOC/libs/LibSpindle/src/Spindle.c - Core/Src/Stepper/src - 2 - virtual:/virtual + Core/Src/Stepper/LibL6474x.c + 1 + PARENT-2-PROJECT_LOC/libs/LibL6474/src/LibL6474x.c Drivers/STM32H7xx_HAL_Driver/Inc/Legacy @@ -779,11 +779,6 @@ 1 PARENT-2-PROJECT_LOC/libs/LibL6474/inc/LibL6474.h - - Core/Src/Stepper/src/LibL6474x.c - 1 - PARENT-2-PROJECT_LOC/libs/LibL6474/src/LibL6474x.c - Drivers/STM32H7xx_HAL_Driver/Inc/Legacy/stm32_hal_legacy.h 1 diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Spindle/spindel.h b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Spindle/spindel.h index c00e03b..b7616d2 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Spindle/spindel.h +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Spindle/spindel.h @@ -1,4 +1,5 @@ #include "Console.h" +#include #include "Spindle.h" #include "main.h" #include "FreeRTOS.h" diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Stepper/stepper.h b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Stepper/stepper.h index a875989..bb1ed07 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Stepper/stepper.h +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/Stepper/stepper.h @@ -2,6 +2,7 @@ #include "Spindle.h" #include "main.h" #include "FreeRTOS.h" +#include "task.h" #include "openamp.h" #include "LibL6474.h" #include @@ -12,12 +13,14 @@ static void StepLibraryFree( const void* const ptr ); static int StepDriverSpiTransfer( void* pIO, char* pRX, const char* pTX, unsigned int length ); -void StepDriverReset(); +void StepDriverReset(void* pGPO, const int ena); -void StepLibraryDelay(); +void StepLibraryDelay(unsigned int ms); -void StepTimerAsync(); +//void StepTimerAsync(); -void StepTimerCancelAsync(); +//void StepTimerCancelAsync(); -L6474_Handle_t init_stepper(); +L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM); + +void reset_stepper(); diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/main.h b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/main.h index a22a4c1..8e370ff 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Inc/main.h +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Inc/main.h @@ -109,6 +109,7 @@ void Error_Handler(void); /* USER CODE END Private defines */ extern TIM_HandleTypeDef htim2; +extern SPI_HandleTypeDef hspi1; #ifdef __cplusplus } diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Src/Stepper/stepper.c b/stm32-stepper-root/stepper_h7/CM7/Core/Src/Stepper/stepper.c index cc035f2..1cf38f1 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Src/Stepper/stepper.c +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Src/Stepper/stepper.c @@ -1,4 +1,5 @@ #include "Stepper/stepper.h" +#include "LibL6474.h" static void* StepLibraryMalloc( unsigned int size ){ @@ -12,14 +13,33 @@ static void StepLibraryFree( const void* const ptr ){ static int StepDriverSpiTransfer( void* pIO, char* pRX, const char* pTX, unsigned int length ){ for ( unsigned int i = 0; i < length; i++ ) { - + HAL_GPIO_WritePin(STEP_SPI_CS_GPIO_Port, STEP_SPI_CS_Pin, GPIO_PIN_RESET); + HAL_SPI_TransmitReceive(&hspi1, pTX, pRX, 1, -1); + HAL_GPIO_WritePin(STEP_SPI_CS_GPIO_Port, STEP_SPI_CS_Pin, GPIO_PIN_SET); } return 0; } +void StepDriverReset(void* pGPO, const int ena){ + if(ena==0){ + HAL_GPIO_WritePin(STEP_RSTN_GPIO_Port, STEP_RSTN_Pin, GPIO_PIN_SET); + }else{ + HAL_GPIO_WritePin(STEP_RSTN_GPIO_Port, STEP_RSTN_Pin, GPIO_PIN_RESET); + } +} + +void StepLibraryDelay(unsigned int ms){ + vTaskDelay(pdMS_TO_TICKS(ms)); +} -L6474_Handle_t init_stepper(){ + +L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){ + + (void)pIO; + (void)pGPO; + (void)pPWM; + L6474x_Platform_t p; p.malloc = StepLibraryMalloc; p.free = StepLibraryFree; @@ -28,4 +48,39 @@ L6474_Handle_t init_stepper(){ p.sleep = StepLibraryDelay; //p.stepAsync = StepTimerAsync; //p.cancelStep = StepTimerCancelAsync; + L6474_Handle_t s = L6474_CreateInstance(&p, pIO, pGPO, pPWM); + + L6474_BaseParameter_t b; + b.stepMode = smMICRO4; // Mikroschritt 1/4 + b.OcdTh = ocdth1125mA; // Überstromschwelle 1125 mA + b.TimeOnMin = 21; // µs (Datenblatt-Standard) + b.TimeOffMin = 21; // µs (Datenblatt-Standard) + b.TorqueVal = 700; // mA, bewusst unter OcdTh + b.TFast = 0x19; // Standardwert (Fast-Decay) + + int result = 0; + + // reset all and take all initialization steps + result |= L6474_ResetStandBy(s); + result |= L6474_Initialize(s, &b); + result |= L6474_SetPowerOutputs(s, 1); + + + + // in case we have no error, we can enable the drivers + // and then we step a bit + if ( result == 0 ) + { + result |= L6474_StepIncremental(s, 100000 ); + } + else + { + // error handling + + } + return s; +} + +void reset_stepper(){ + } diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Src/main.c b/stm32-stepper-root/stepper_h7/CM7/Core/Src/main.c index e1c93a8..536c44b 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Src/main.c +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Src/main.c @@ -318,6 +318,9 @@ int main(void) //Spindle init_spindle(c, 9000, -9000, 1600); + //Stepepr + init_stepper(NULL, NULL, NULL); + // tasks diff --git a/stm32-stepper-root/stepper_h7/CM7/Core/Src/stm32h7xx_it.c b/stm32-stepper-root/stepper_h7/CM7/Core/Src/stm32h7xx_it.c index 2e1d94b..83eab84 100644 --- a/stm32-stepper-root/stepper_h7/CM7/Core/Src/stm32h7xx_it.c +++ b/stm32-stepper-root/stepper_h7/CM7/Core/Src/stm32h7xx_it.c @@ -82,7 +82,7 @@ void NMI_Handler(void) * @brief This function handles Hard fault interrupt. */ void HardFault_Handler(void) -{ + { /* USER CODE BEGIN HardFault_IRQn 0 */ /* USER CODE END HardFault_IRQn 0 */