from nanpy import Stepper
from nanpy import SerialManager
from time import sleep
import paho.mqtt.client as mqtt
import json
import threading

kit = ""
motor1 = None
motor2 = None

steps = 3800
numsteps = 1990


def setup():
	connection = SerialManager(device='/dev/ttyACM0')

	motor1 = Stepper(connection=connection, revsteps=steps,
						pin1=4, pin2=5, pin3=6, pin4=7)
	motor2 = Stepper(connection=connection, revsteps=steps,
						pin1=8, pin2=9, pin3=10, pin4=11)
	motor1.setSpeed(5)
	motor2.setSpeed(5)


def loop():
	while True:
		print(kit)
    # if(kit == 'asdf1f'):
    #     motor1.step(numsteps)
    #     print("Activated motor 1")
    # if(kit == '2'):
    #     motor2.step(numsteps)
    #     print("Activated motor 2")


def on_connect(client, userdata, flags, rc):
    print("Connected to broker, result: "+str(rc))
    client.subscribe("/dispenser/dispense")


def on_message(client, userdata, msg):
    json_data = json.loads(msg.payload.decode("utf-8"))
    kit = json_data['id']


#user = "iurigkzv"
#password = "ywgljptjPEAp"
client = mqtt.Client()
#client.username_pw_set(user, password)
client.on_connect = on_connect
client.on_message = on_message
client.connect("test.mosquitto.org", 1883, 60)
client.loop_forever()

try:
	setup()
except Exception as e:
	print(e)
loopThread = threading.Thread(loop)
loopThread.daemon = True
loopThread.run()