marisa/Spectrometer
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fix gpio setmode

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files

5
motor_passo/__main__.py
View File

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

13
motor_passo/motor.py
View File

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