import sys

from spectrometer.motor import Motor
from spectrometer.encoder import Encoder
from spectrometer.utils.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()