3Stepper::Stepper(GPIO_TypeDef *GPIO_Port_step, uint16_t GPIO_Pin_step, GPIO_TypeDef *GPIO_Port_dir, uint16_t GPIO_Pin_dir, uint16_t Resolution)
4 : GPIO_Port_step(GPIO_Port_step), GPIO_Pin_step(GPIO_Pin_step),
5 GPIO_Port_dir(GPIO_Port_dir), GPIO_Pin_dir(GPIO_Pin_dir), Resolution(Resolution), CurrentDirection(true),
6 CurrentPositionSteps(0), CurrentPositionDegrees(0.0f), CurrentPositionRadian(0.0f),
11uint32_t Stepper::GetStepsFromDegrees(
float degrees)
13 return static_cast<uint32_t
>((degrees / 360.0f) * Resolution);
16uint32_t Stepper::GetStepsFromRadian(
float radian)
18 return static_cast<uint32_t
>((radian / (2.0f * M_PI)) * Resolution);
21float Stepper::GetDegreesFromSteps(int32_t steps)
23 return (
static_cast<float>(steps) / Resolution) * 360.0f;
26float Stepper::GetRadianFromSteps(int32_t steps)
28 return (
static_cast<float>(steps) / Resolution) * (2.0f * M_PI);
31void Stepper::HalfStep()
33 HAL_GPIO_TogglePin(GPIO_Port_step, GPIO_Pin_step);
38 RotateSteps(GetStepsFromDegrees(degrees), dir, GetStepsFromDegrees(speed));
43 RotateSteps(GetStepsFromRadian(radian), dir, GetStepsFromRadian(speed));
48 if (steps == 0 || speed <= 0.0f)
52 HAL_GPIO_WritePin(GPIO_Port_dir, GPIO_Pin_dir, dir ? GPIO_PIN_SET : GPIO_PIN_RESET);
54 my_stepper.remaining = 2 * steps;
55 my_stepper.interval =
static_cast<uint32_t
>(1000.0f / (2 * speed));
56 my_stepper.last_tick = HAL_GetTick();
62 if (my_stepper.remaining > 0)
64 uint32_t now = HAL_GetTick();
65 if ((now - my_stepper.last_tick) >= my_stepper.interval)
68 my_stepper.remaining--;
69 my_stepper.last_tick = now;
70 if (my_stepper.remaining % 2 == 0)
int32_t CurrentPositionSteps
void RotateSteps(uint32_t steps, bool dir, float speed)
float CurrentPositionRadian
void RotateDegrees(float degrees, bool dir, float speed)
void RotateRadian(float radian, bool dir, float speed)
float CurrentPositionDegrees
Stepper(GPIO_TypeDef *GPIO_Port_step, uint16_t GPIO_Pin_step, GPIO_TypeDef *GPIO_Port_dir, uint16_t GPIO_Pin_dir, uint16_t Resolution)