Fix gpio setmode

This commit is contained in:
2023-10-29 20:56:03 -03:00
parent a1abc0b424
commit a066b13d20
2 changed files with 12 additions and 6 deletions

View File

@@ -2,9 +2,10 @@ from motor_passo.motor import Motor
def main():
motor = Motor([5, 6, 13])
motor = Motor([13, 19, 26])
motor.setup()
motor.step(24 * 2)
motor.set_speed(90)
motor.step(24 * 100)
if __name__ == "__main__":

View File

@@ -10,13 +10,19 @@ class Motor:
rev_steps: int = 24
_delay: int = 0
_step_configs: list[list[int]] = field(default_factory=lambda: [
[[1, 0, 0], [0, 1, 0], [0, 0, 1]],
])
def __post_init__(self) -> None:
self.set_speed(4)
def setup(self) -> None:
gpio.setmode(gpio.BCM)
for pin in self.pins:
gpio.setmode(pin, gpio.OUT)
gpio.setup(pin, gpio.OUT)
gpio.output(pin, gpio.LOW)
def step(self, steps: int) -> None:
direction = int(steps / abs(steps))
@@ -32,13 +38,12 @@ class Motor:
sleep(self._delay)
def set_speed(self, rpm: int) -> None:
self._delay = 60 * 1000 / self.rev_steps / rpm
self._delay = 60 / self.rev_steps / rpm
def _step(self, step_num: int):
assert (step_num >= 0 and step_num < 3)
confs = [[1, 0, 0], [0, 1, 0], [0, 0, 1]]
conf = confs[step_num]
conf = self._step_configs[0][step_num]
for p, c in zip(self.pins, conf):
gpio.output(p, c)