1
1
#include " FastAccelStepper.h"
2
2
3
3
// As in StepperDemo for Motor 1 on AVR
4
- // #define dirPinStepper 5
5
- // #define enablePinStepper 6
6
- // #define stepPinStepper 9 // OC1A in case of AVR
4
+ // #define dirPinStepper 5
5
+ // #define enablePinStepper 6
6
+ // #define stepPinStepper 9 // OC1A in case of AVR
7
7
8
8
// As in StepperDemo for Motor 1 on ESP32
9
9
#define dirPinStepper 18
13
13
FastAccelStepperEngine engine = FastAccelStepperEngine();
14
14
FastAccelStepper *stepper = NULL ;
15
15
16
-
17
16
void setup () {
18
17
printf (" START\n " );
19
- for (uint8_t i = 0 ;i < 10 ;i++) {
20
- printf (" LOOP %d\n " ,i);
18
+ for (uint8_t i = 0 ; i < 10 ; i++) {
19
+ printf (" LOOP %d\n " , i);
21
20
vTaskDelay (pdMS_TO_TICKS (500 ));
22
21
esp_task_wdt_reset ();
23
22
}
24
23
25
24
engine.init (0 );
26
25
27
26
printf (" Engine initialized\n " );
28
- for (uint8_t i = 0 ;i < 10 ;i++) {
29
- printf (" LOOP %d\n " ,i);
27
+ for (uint8_t i = 0 ; i < 10 ; i++) {
28
+ printf (" LOOP %d\n " , i);
30
29
vTaskDelay (pdMS_TO_TICKS (500 ));
31
30
esp_task_wdt_reset ();
32
31
}
33
32
34
33
stepper = engine.stepperConnectToPin (stepPinStepper);
35
34
36
35
printf (" Stepper connected\n " );
37
- for (uint8_t i = 0 ;i < 10 ;i++) {
38
- printf (" LOOP %d\n " ,i);
36
+ for (uint8_t i = 0 ; i < 10 ; i++) {
37
+ printf (" LOOP %d\n " , i);
39
38
vTaskDelay (pdMS_TO_TICKS (500 ));
40
39
esp_task_wdt_reset ();
41
40
}
42
41
43
42
if (stepper) {
44
- // stepper->setDirectionPin(dirPinStepper);
45
- // stepper->setEnablePin(enablePinStepper);
46
- // stepper->setAutoEnable(true);
43
+ // stepper->setDirectionPin(dirPinStepper);
44
+ // stepper->setEnablePin(enablePinStepper);
45
+ // stepper->setAutoEnable(true);
47
46
48
47
// If auto enable/disable need delays, just add (one or both):
49
48
// stepper->setDelayToEnable(50);
@@ -53,32 +52,31 @@ void setup() {
53
52
stepper->setAcceleration (100 );
54
53
stepper->move (1000 );
55
54
printf (" Stepper initialized\n " );
56
- }
57
- else {
55
+ } else {
58
56
printf (" No stepper\n " );
59
57
}
60
58
61
- for (uint8_t i = 0 ;i < 10 ;i++) {
62
- printf (" LOOP %d\n " ,i);
59
+ for (uint8_t i = 0 ; i < 10 ; i++) {
60
+ printf (" LOOP %d\n " , i);
63
61
vTaskDelay (pdMS_TO_TICKS (500 ));
64
62
esp_task_wdt_reset ();
65
63
}
66
64
}
67
65
68
66
void loop () {
69
- while (stepper->isRunning ()) {
70
- esp_task_wdt_reset ();
71
- printf (" pos=%d\n " , stepper->getCurrentPosition ());
72
- vTaskDelay (pdMS_TO_TICKS (500 ));
73
- }
74
- stepper->move (1000 );
67
+ while (stepper->isRunning ()) {
68
+ esp_task_wdt_reset ();
69
+ printf (" pos=%d\n " , stepper->getCurrentPosition ());
70
+ vTaskDelay (pdMS_TO_TICKS (500 ));
71
+ }
72
+ stepper->move (1000 );
75
73
}
76
74
77
- extern " C" void app_main ()
78
- {
75
+ extern " C" void app_main () {
79
76
setup ();
80
- while (true ) {
81
- loop ();
77
+ while (true ) {
78
+ loop ();
82
79
}
83
- // WARNING: if program reaches end of function app_main() the MCU will restart.
80
+ // WARNING: if program reaches end of function app_main() the MCU will
81
+ // restart.
84
82
}
0 commit comments