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

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

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

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

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

    /// Energize pins for the step index `this_step % 4`.
    fn step(&mut self, this_step: u32) -> Result<(), Self::Error> {
        match this_step % 4 {
            0 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
            }
            1 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_high();
                let _ = self.p4.set_low();
            }
            2 => {
                let _ = self.p1.set_low();
                let _ = self.p2.set_high();
                let _ = self.p3.set_low();
                let _ = self.p4.set_high();
            }
            3 => {
                let _ = self.p1.set_high();
                let _ = self.p2.set_low();
                let _ = self.p3.set_low();
                let _ = self.p4.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();
        Ok(())
    }
}