from leash.lumen import Lumen

lumen = Lumen()

if lumen.connect():
    try:
        lumen.home()

        # .goto() sends a move command with any optional arguments x, y, z, a, and b
        lumen.goto(x=10 y=10)
        lumen.goto(z=20)

        lumen.safeZ()

        # To make sure Lumen actions align with your code timing, use lumen.sleep()
        # This just makes sure all commands are complete before delaying
        # lumen.sleep() can be handy in situations where you want to keep a pump
        # on for a certain amount of time, for example:
        # 
        #   lumen.rightPump.on()
        #   lumen.sleep(1)
        #   lumen.rightPump.readPressure()
        #   lumen.rightPump.off() 
        #

        lumen.sleep(2)

        # If you need more control, you can use lumen.finishMoves() which blocks until
        # the Lumen's command queue is empty
        lumen.finishMoves()
        # You can then use any other delays or timing functions afterwards
        time.sleep(1)

        # Pumps

        lumen.leftPump.on()
        lumen.sleep(1)
        print("Left sensor pressure: " + str(lumen.leftPump.getPressure()))
        lumen.leftPump.off()

        lumen.rightPump.on()
        lumen.sleep(1)
        print("Right sensor pressure: " + str(lumen.rightPump.getPressure()))
        lumen.rightPump.off()

        print("Left sensor temperature: " + str(lumen.leftPump.getTemperature())))
        print("Right sensor temperature: " + str(lumen.rightPump.getTemperature()))

        # Ring Lights

        lumen.topLight.on(218, 165, 32, 255)
        lumen.sleep(1)
        lumen.topLight.off()

        lumen.botLight.on(218, 165, 32, 255)
        lumen.sleep(1)
        lumen.botLight.off()

        # Feeders

        myLumen.photon.scan()
        print(myLumen.photon.activeFeeders)
    
    except KeyboardInterrupt:
        lumen.idle()