30 lines
537 B
Python
30 lines
537 B
Python
import sys
|
|
|
|
from motor_passo.motor import Motor
|
|
from motor_passo.encoder import Encoder
|
|
from motor_passo.utils import setup_cleanup, _cleanup
|
|
|
|
|
|
def main(args: list):
|
|
setup_cleanup()
|
|
|
|
motor = Motor([13, 19, 26])
|
|
motor.setup()
|
|
motor.set_speed(50)
|
|
|
|
encoder = Encoder(6, 5)
|
|
encoder.setup()
|
|
|
|
while encoder.angle <= 360:
|
|
motor.step(-5)
|
|
print(encoder.angle)
|
|
|
|
|
|
if __name__ == "__main__":
|
|
try:
|
|
main(sys.argv)
|
|
except Exception as e:
|
|
print(str(e))
|
|
finally:
|
|
_cleanup()
|