forked from jamesfowkes/cryptology-barnsley-iris
-
Notifications
You must be signed in to change notification settings - Fork 0
/
iris.cpp
61 lines (49 loc) · 849 Bytes
/
iris.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
#include <Arduino.h>
#include <Stepper.h>
#include "iris.h"
#if defined(IRIS_HOMED_WHEN_CLOSED)
void iris_home(Stepper& stepper)
{
iris_close(stepper);
}
bool iris_is_closed()
{
return digitalRead(IRIS_HOME_PIN) == LOW;
}
void iris_close(Stepper& stepper)
{
stepper.setSpeed(IRIS_SPEED);
while (!iris_is_closed())
{
stepper.step(1);
delayMicroseconds(100);
}
}
void iris_open(Stepper& stepper)
{
stepper.step(-IRIS_OPEN_POSITION);
}
#endif
#if defined(IRIS_HOMED_WHEN_OPEN)
void iris_home(Stepper& stepper)
{
iris_open(stepper);
}
bool iris_is_open()
{
return digitalRead(IRIS_HOME_PIN) == LOW;
}
void iris_open(Stepper& stepper)
{
stepper.setSpeed(IRIS_SPEED);
while (!iris_is_open())
{
stepper.step(1);
delayMicroseconds(100);
}
}
void iris_close(Stepper& stepper)
{
stepper.step(-IRIS_CLOSE_POSITION);
}
#endif