x = Axis()
#x.attach(Motor(mh[1], 1, 1), LS[2], LS[3])
#x.attach(Motor(mh[1], 2, 1), LS[1], LS[4])
y = Axis()
y.attach(Motor(mh[0], 1, 0), LS[6], LS[5])
print "Ready!"
print "Homing X and Y Axes"
#x.homeAxis()
y.homeAxis()
# wait for x and y axis to home
while(not y.atHome()) and ON_PI:
time.sleep(0.5)
print "X and Y Axes Homed"
done = False
while(not done):
txt = raw_input("Press Enter to continue...")
if(txt == "Is Y Moving"):
print y.isMoving()
if(txt == "Is X Moving"):
print x.isMoving()
if(txt == "r"):
y.move(0)
if(txt == "l"):
y.move(1)
