embedded-stepper 0.1.2

Hardware agnostic, no_std stepper motor driver based on Arduino stepper using embedded-hal
Documentation 
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
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119

//! 5-pin stepper coil driver with no error handling

use embedded_hal::digital::OutputPin;
use crate::driver::StepperMotor;

/// Coil driver using five output pins.
pub struct StepperMotor5<P1: OutputPin, P2: OutputPin, P3: OutputPin, P4: OutputPin, P5: OutputPin>
where
    P1: OutputPin,
    P2: OutputPin<Error = P1::Error>,
    P3: OutputPin<Error = P1::Error>,
    P4: OutputPin<Error = P1::Error>,
    P5: OutputPin<Error = P1::Error>,
{
    pub p1: P1,
    pub p2: P2,
    pub p3: P3,
    pub p4: P4,
    pub p5: P5,
}

impl<P1, P2, P3, P4, P5> StepperMotor for StepperMotor5<P1, P2, P3, P4, P5>
where
    P1: OutputPin,
    P2: OutputPin<Error = P1::Error>,
    P3: OutputPin<Error = P1::Error>,
    P4: OutputPin<Error = P1::Error>,
    P5: OutputPin<Error = P1::Error>,
{
    type Error = ();

    /// Energize pins for the step index `this_step % 10`.
    fn step(&mut self, this_step: u32) -> Result<(), Self::Error> {
        match this_step % 10 {
            0 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
                let _ = self.p5.set_high();
            },
            1 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_low();
                let _ = self.p4.set_low();
                let _ = self.p5.set_high();
            },
            2 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_low();
                let _ = self.p4.set_high();
                let _ = self.p5.set_high();
            },
            3 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_low();
                let _ = self.p4.set_high();
                let _ = self.p5.set_low();
            },
            4 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_high();
                let _ = self.p3.set_low();
                let _ = self.p4.set_high();
                let _ = self.p5.set_low();
            },
            5 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_low();
                let _ = self.p4.set_high();
                let _ = self.p5.set_low();
            },
            6 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_high();
                let _ = self.p4.set_high();
                let _ = self.p5.set_low();
            },
            7 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
                let _ = self.p5.set_low();
            },
            8 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
                let _ = self.p5.set_high();
            },
            9 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_low();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
                let _ = self.p5.set_high();
            },
            _ => unreachable!(),
        }
        Ok(())
    }

    /// Drive all pins low to de-energize the motor.
    fn clear(&mut self) -> Result<(), Self::Error> {
        let _ = self.p1.set_low();
        let _ = self.p2.set_low();
        let _ = self.p3.set_low();
        let _ = self.p4.set_low();
        let _ = self.p5.set_low();
        Ok(())
    }
}