RogiStandard-hal
STM32 向けサークル共通ライブラリ
読み取り中…
検索中…
一致する文字列を見つけられません
Stepper.cpp
[詳解]
1#include "Stepper.hpp"
2
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),
7 my_stepper({0, 0, 0})
8{
9}
10
11uint32_t Stepper::GetStepsFromDegrees(float degrees)
12{
13 return static_cast<uint32_t>((degrees / 360.0f) * Resolution);
14}
15
16uint32_t Stepper::GetStepsFromRadian(float radian)
17{
18 return static_cast<uint32_t>((radian / (2.0f * M_PI)) * Resolution);
19}
20
21float Stepper::GetDegreesFromSteps(int32_t steps)
22{
23 return (static_cast<float>(steps) / Resolution) * 360.0f;
24}
25
26float Stepper::GetRadianFromSteps(int32_t steps)
27{
28 return (static_cast<float>(steps) / Resolution) * (2.0f * M_PI);
29}
30
31void Stepper::HalfStep()
32{
33 HAL_GPIO_TogglePin(GPIO_Port_step, GPIO_Pin_step);
34}
35
36void Stepper::RotateDegrees(float degrees, bool dir, float speed)
37{
38 RotateSteps(GetStepsFromDegrees(degrees), dir, GetStepsFromDegrees(speed));
39}
40
41void Stepper::RotateRadian(float radian, bool dir, float speed)
42{
43 RotateSteps(GetStepsFromRadian(radian), dir, GetStepsFromRadian(speed));
44}
45
46void Stepper::RotateSteps(uint32_t steps, bool dir, float speed)
47{
48 if (steps == 0 || speed <= 0.0f)
49 {
50 return;
51 }
52 HAL_GPIO_WritePin(GPIO_Port_dir, GPIO_Pin_dir, dir ? GPIO_PIN_SET : GPIO_PIN_RESET);
53 CurrentDirection = dir;
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();
57 return;
58}
59
61{
62 if (my_stepper.remaining > 0)
63 {
64 uint32_t now = HAL_GetTick();
65 if ((now - my_stepper.last_tick) >= my_stepper.interval)
66 {
67 HalfStep();
68 my_stepper.remaining--;
69 my_stepper.last_tick = now;
70 if (my_stepper.remaining % 2 == 0)
71 {
73 CurrentPositionDegrees = GetDegreesFromSteps(CurrentPositionSteps);
74 CurrentPositionRadian = GetRadianFromSteps(CurrentPositionSteps);
75 }
76 }
77 }
78}
int32_t CurrentPositionSteps
Definition Stepper.hpp:37
void RotateSteps(uint32_t steps, bool dir, float speed)
Definition Stepper.cpp:46
float CurrentPositionRadian
Definition Stepper.hpp:39
bool CurrentDirection
Definition Stepper.hpp:36
void RotateDegrees(float degrees, bool dir, float speed)
Definition Stepper.cpp:36
void RotateRadian(float radian, bool dir, float speed)
Definition Stepper.cpp:41
float CurrentPositionDegrees
Definition Stepper.hpp:38
Stepper(GPIO_TypeDef *GPIO_Port_step, uint16_t GPIO_Pin_step, GPIO_TypeDef *GPIO_Port_dir, uint16_t GPIO_Pin_dir, uint16_t Resolution)
Definition Stepper.cpp:3
void UpdateStepper()
Definition Stepper.cpp:60