def grid_pick(c,ser_ee,x,y,z,r,stack=1):
ic.socket_send(c,sCMD=300) # select lego tcp (tool centre point)
demand_Joints = dict(grid_pos(c,x,y,z+1+stack,r))
msg = ic.safe_ur_move(c,Pose=demand_Joints,CMD=2,Speed=1.05) # move above brick
#ic.super_serial_send(ser_ee,"G",51)
demand_Joints = dict(grid_pos(c,x,y,z-0.1+stack,r))
msg = ic.safe_ur_move(c,Pose=demand_Joints,CMD=2,Speed=0.5)
demand_Joints = dict(grid_pos(c,x,y,z-1+stack,r))
msg = ic.safe_ur_move(c,Pose=demand_Joints,CMD=2,Speed=0.1)
if stack == 1:
ic.super_serial_send(ser_ee,"G",49) # close grabber
ic.socket_send(c,sCMD=299+stack)
demand_Pose = dict(smooth_rotate(c,R=15))
#print "demand_Pose: ",demand_Pose
#ipt = raw_input("continue?")
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8) # rotate grabber
current_Pose = ic.get_ur_position(c,1)
demand_Pose = {'x':current_Pose[0],'y':current_Pose[1],'z':current_Pose[2]+20,'rx':current_Pose[3],'ry':current_Pose[4],'rz':current_Pose[5]}
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8)
demand_Joints = dict(grid_pos(c,x,y,z+1+stack,r))
msg = ic.safe_ur_move(c,Pose=demand_Joints,CMD=2,Speed=0.5) # move back up
def smooth_rotate(c,R=15):
# Rotation axis in end-effector co-ordinate system
R2 = [0,-1,0]
T2 = R
trans = {'x':0,'y':0,'z':0,'rx':T2*R2[0],'ry':T2*R2[1],'rz':T2*R2[2]} # pose decribing transformation (no translation, rotation about defined axis)
trans_pose = ic.get_ur_position(c,11,trans) # returns current pose transformed by 'trans'
return {"x": trans_pose[0], "y": trans_pose[1], "z": trans_pose[2], "rx": trans_pose[3], "ry": trans_pose[4], "rz": trans_pose[5]}
def smooth_rotate(c, R=15):
# axis-angle combination formula
#current_Pose = ic.get_ur_position(c,1)
#T1 = math.pi*math.sqrt(current_Pose[3]*current_Pose[3]+current_Pose[4]*current_Pose[4]+current_Pose[5]*current_Pose[5])/180
#R1 = np.array([current_Pose[3]*math.pi/(180*T1),
# current_Pose[4]*math.pi/(180*T1),
# current_Pose[5]*math.pi/(180*T1)])
#if r == 0:
# T2 = math.pi*R/180
# dx = (wp.grid_30_13['x']-wp.grid_30_1['x'])*math.pi/180
# dy = (wp.grid_30_13['y']-wp.grid_30_1['y'])*math.pi/180
# dz = (wp.grid_30_13['z']-wp.grid_30_1['z'])*math.pi/180
# norm = math.sqrt(dx*dx+dy*dy+dz*dz)
# R2 = np.array([dx/norm,
# dy/norm,
# dz/norm])
#T3 = 2*math.acos(math.cos(T1/2)*math.cos(T2/2)-math.sin(T1/2)*math.sin(T2/2)*np.dot(R1,R2))
#R3 = (math.sin(T2/2)*math.cos(T1/2)*R2+math.cos(T2/2)*math.sin(T1/2)*R1+math.sin(T2/2)*math.sin(T1/2)*np.cross(R2,R2))/math.sin(T3/2)
#return {"x": current_Pose[0], "y": current_Pose[1], "z": current_Pose[2], "rx": T3*R3[0]*180/math.pi, "ry": T3*R3[1]*180/math.pi, "rz": T3*R3[2]*180/math.pi}
# Rotation axis in end-effector co-ordinate system
R2 = [0, -1, 0]
T2 = R
trans = {
'x': 0,
'y': 0,
'z': 0,
'rx': T2 * R2[0],
'ry': T2 * R2[1],
'rz': T2 * R2[2]
} # pose decribing transformation (no translation, rotation about defined axis)
trans_pose = ic.get_ur_position(
c, 11, trans) # returns current pose transformed by 'trans'
return {
"x": trans_pose[0],
"y": trans_pose[1],
"z": trans_pose[2],
"rx": trans_pose[3],
"ry": trans_pose[4],
"rz": trans_pose[5]
}
def feed_place2(c,ser_ee,sH=0):
ic.socket_send(c,sCMD=300) # select lego tcp (tool centre point)
# separate stack by placing in pick position
demand_Pose = copy.deepcopy(wp.Hopper0_feed1)
demand_Pose['z'] = demand_Pose['z']+38
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=4) # move above brick
demand_Pose['z'] = demand_Pose['z']-20.5
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8,Speed=0.25)
demand_Pose = dict(smooth_rotate(c,R=15))
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8) # rotate grabber
current_Pose = ic.get_ur_position(c,1)
demand_Pose = {'x':current_Pose[0],'y':current_Pose[1],'z':current_Pose[2]+80,'rx':current_Pose[3],'ry':current_Pose[4],'rz':current_Pose[5]}
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8)
feed_place(c,ser_ee,H=sH)
demand_Pose = copy.deepcopy(wp.Hopper0_feed1)
demand_Pose['z'] = demand_Pose['z']+28.5
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=4) # move above brick
demand_Pose['z'] = demand_Pose['z']-20
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8)
ic.super_serial_send(ser_ee,"G",49)
demand_Pose['x'] = wp.Hopper0_feed0['x']
demand_Pose['y'] = wp.Hopper0_feed0['y']
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8)
demand_Pose = dict(smooth_rotate(c,R=30))
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8) # rotate grabber
demand_Pose['z'] = demand_Pose['z']+80
msg = ic.safe_ur_move(c,Pose=demand_Pose,CMD=8)
#feed_place(c,ser_ee,H=sH)
return
def grid_pos(c,x,y,z,r):
# x:0-31
# y:0-15
# z:0-31
# r:0/90
nx = 30
ny = 12
nz = 9
# dx = {"x": (wp.grid_30_1['x']-wp.grid_0_1['x'])/nx, "y": (wp.grid_30_1['y']-wp.grid_0_1['y'])/nx, "z": (wp.grid_30_1['z']-wp.grid_0_1['z'])/nx, "rx": 0, "ry": 0, "rz": 0}
dy1 = {"x": (wp.grid_0_13['x']-wp.grid_0_1['x'])/ny, "y": (wp.grid_0_13['y']-wp.grid_0_1['y'])/ny, "z": (wp.grid_0_13['z']-wp.grid_0_1['z'])/ny, "rx": 0, "ry": 0, "rz": 0}
dy2 = {"x": (wp.grid_30_13['x']-wp.grid_30_1['x'])/ny, "y": (wp.grid_30_13['y']-wp.grid_30_1['y'])/ny, "z": (wp.grid_30_13['z']-wp.grid_30_1['z'])/ny, "rx": 0, "ry": 0, "rz": 0}
dz = {"x": (wp.grid_30_1_10['x']-wp.grid_30_1['x'])/nz, "y": (wp.grid_30_1_10['y']-wp.grid_30_1['y'])/nz, "z": (wp.grid_30_1_10['z']-wp.grid_30_1['z'])/nz, "rx": 0, "ry": 0, "rz": 0}
y1_Pose = {"x": wp.grid_0_1['x'] + (y-1)*dy1['x'] + z*dz['x'],
"y": wp.grid_0_1['y'] + (y-1)*dy1['y'] + z*dz['y'],
"z": wp.grid_0_1['z'] + (y-1)*dy1['z'] + z*dz['z'],
"rx": wp.grid_0_1['rx'], "ry": wp.grid_0_1['ry'], "rz": wp.grid_0_1['rz']}
y2_Pose = {"x": wp.grid_30_1['x'] + (y-1)*dy2['x'] + z*dz['x'],
"y": wp.grid_30_1['y'] + (y-1)*dy2['y'] + z*dz['y'],
"z": wp.grid_30_1['z'] + (y-1)*dy2['z'] + z*dz['z'],
"rx": wp.grid_30_1['rx'], "ry": wp.grid_0_1['ry'], "rz": wp.grid_0_1['rz']}
grid_Pose = {"x": ((nx-x)*y1_Pose['x'] + x*y2_Pose['x'])/nx,
"y": ((nx-x)*y1_Pose['y'] + x*y2_Pose['y'])/nx,
"z": ((nx-x)*y1_Pose['z'] + x*y2_Pose['z'])/nx,
"rx": wp.grid_0_1['rx'], "ry": wp.grid_0_1['ry'], "rz": wp.grid_0_1['rz']}
ic.socket_send(c,sCMD=300)
calculated_Joints = ic.get_ur_position(c,10,gPose=dict(grid_Pose)) # uses UR inverse kinematics solver to get joint positions, then add rotation for brick orienation
grid_Joints = {"x": calculated_Joints[0], "y": calculated_Joints[1], "z": calculated_Joints[2], "rx": calculated_Joints[3], "ry": calculated_Joints[4], "rz": calculated_Joints[5]+r}
if calculated_Joints[5] > 270:
grid_Joints["rz"] = calculated_Joints[5]+r-360
return grid_Joints
def main():
ipt = raw_input("Robot connected?(y/n)")
if ipt == "y":
c, ser_ee = initialize()
# loop
print c.recv(1024)
inp = raw_input("Continue?")
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
while True:
task = raw_input("task: ")
if task == "o":
ic.super_serial_send(ser_ee, "G", 51)
if task == "c":
ic.super_serial_send(ser_ee, "G", 49)
if task == "cal":
ipt = raw_input("Continue?")
lm.grid_pick(c, ser_ee, 0, 1, 0, 0)
lm.grid_place(c, ser_ee, 0, 1, 0, 0)
ipt = raw_input("Continue?")
lm.grid_pick(c, ser_ee, 30, 1, 0, 0)
lm.grid_place(c, ser_ee, 30, 1, 0, 0)
ipt = raw_input("Continue?")
lm.grid_pick(c, ser_ee, 30, 13, 0, 0)
lm.grid_place(c, ser_ee, 30, 13, 0, 0)
ipt = raw_input("Continue?")
lm.grid_pick(c, ser_ee, 0, 13, 0, 0)
lm.grid_place(c, ser_ee, 0, 13, 0, 0)
ipt = raw_input("Continue?")
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
if task == "stack":
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
time.sleep(3)
lm.stack_pick(c, ser_ee, 0, 1, 2, 0, stack=3)
lm.grid_place(c, ser_ee, 30, 1, 2, 0)
if task == "rot":
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
ic.socket_send(c, sCMD=300)
current_Pose = ic.get_ur_position(c, 1)
demand_Pose = {
"x": current_Pose[0],
"y": current_Pose[1],
"z": current_Pose[2],
"rx": current_Pose[3],
"ry": current_Pose[4],
"rz": current_Pose[5]
}
print "current_Pose: ", demand_Pose
demand_Pose = dict(lm.smooth_rotate(c, 0, R=20))
print "demand_Pose: ", demand_Pose
ipt = raw_input("continue?")
msg = ic.safe_ur_move(c, Pose=demand_Pose, CMD=8)
# if task == "lego":
# #time.sleep(5)
# ipt = raw_input("Open?(y/n)")
# if ipt == "y":
# ic.super_serial_send(ser_ee,"G",51)
# for i in range(0,3):
# for j in range(0,4):
# for k in range(0,2):
# lm.grid_pick(c,ser_ee,j*8+3,k*6+1,4,0)
# lm.grid_place(c,ser_ee,j*8+3,k*6+7,4,0)
# msg = ic.safe_ur_move(c,Pose=dict(wp.home_joints),CMD=2)
# for j in range(0,4):
# for k in range(0,2):
# lm.grid_pick(c,ser_ee,27-j*8,13-k*6,4,0)
# lm.grid_place(c,ser_ee,27-j*8,7-k*6,4,0)
# msg = ic.safe_ur_move(c,Pose=dict(wp.home_joints),CMD=2)
if task == "lego":
ic.socket_send(c, sCMD=300)
lm.grid_pick(c, ser_ee, 0, 1, 0, 0)
if task == "pt":
#time.sleep(5)
ipt = raw_input("Open?(y/n)")
if ipt == "y":
ic.super_serial_send(ser_ee, "G", 51)
for i in range(0, 4):
for j in range(0, 4):
for k in range(0, 2):
lm.grid_pick(c, ser_ee, ((j + k) * 8 + 3) % 32,
k * 6 + 1, 1, 0)
lm.grid_place(c, ser_ee, ((j + k + 1) * 8 + 3) % 32,
k * 6 + 7, 1, 0)
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
for j in range(0, 4):
lm.grid_pick(c, ser_ee, j * 8 + 3, 13, 1, 0)
lm.grid_place(c, ser_ee, ((j + 1) * 8 + 3) % 32, 1, 1, 0)
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
if task == "wp":
msg = ic.safe_ur_move(c, Pose=dict(wp.feed_stow_wp_joints), CMD=2)
if task == "pose":
current_Pose = ic.get_ur_position(c, 1)
print "current pose: ", current_Pose
if task == "joints":
current_Joints, current_Grip = ic.get_ur_position(c, 3)
print "current joints: ", current_Joints
if task == "dis":
model = fd.import_file("example.txt")
bricks = fd.decode_file(model)
que, opt = dis.sort_bricks_dis(bricks, model)
print opt
print "x\ty\tp\tr\tex\tey"
for i in range(0, len(que)):
print que[i]['x'], '\t', que[i]['y'], '\t', que[i][
'p'], '\t', que[i]['r'], '\t', que[i]['ye'], '\t', que[i][
'xe']
lm.clean_disassemble(c, ser_ee, que)
if task == "disre":
ipt = raw_input("Open?(y/n)")
if ipt == "y":
ic.super_serial_send(ser_ee, "G", 51)
model = fd.import_file("examplere.txt")
bricks = fd.decode_file(model)
que, opt = dis.sort_bricks_dis(bricks, model)
print opt
print "x\ty\tp\tr\tex\tey"
for i in range(0, len(que)):
print que[i]['x'], '\t', que[i]['y'], '\t', que[i][
'p'], '\t', que[i]['r'], '\t', que[i]['ye'], '\t', que[i][
'xe']
ipt = raw_input("continue?")
#lm.assemble(c,ser_ee,bricks)
#ipt = raw_input("continue?")
lm.clean_disassemble(c, ser_ee, que)
if task == "ass":
model = fd.import_file("example.txt")
bricks = fd.decode_file(model)
que, opt = ass.sort_bricks_ass(bricks, model)
print opt
print "x\ty\tp\tr\tex\tey"
for i in range(0, len(que)):
print que[i]['x'], '\t', que[i]['y'], '\t', que[i][
'p'], '\t', que[i]['r'], '\t', que[i]['ye'], '\t', que[i][
'xe']
ipt = raw_input('Continue?')
if ipt == 'y':
lm.clean_assemble(c, ser_ee, que)
if task == "assre":
ipt = raw_input("Open?(y/n)")
if ipt == "y":
ic.super_serial_send(ser_ee, "G", 51)
model = fd.import_file("examplere.txt")
bricks = fd.decode_file(model)
que, opt = ass.sort_bricks_ass(bricks, model)
print opt
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'] + que[i][
'p'], ', ', que[i]['z']
else:
print que[i]['x'] + que[i]['p'], ', ', que[i][
'y'], ', ', que[i]['z']
ipt = raw_input("continue?")
#lm.assemble(c,ser_ee,bricks)
#ipt = raw_input("continue?")
lm.assemble(c, ser_ee, que)
if task == "i":
model = fd.import_file("example.txt")
#print get_size(model)
if task == "stow":
h = int(raw_input("H: "))
s = int(raw_input("stack: "))
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
if s == 2:
lm.feed_place2(c, ser_ee, sH=h)
lm.feed_place(c, ser_ee, H=h)
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
if task == "pick":
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
h = int(raw_input("H: "))
x = int(raw_input("x: "))
s = int(raw_input("stack: "))
lm.feed_pick(c, ser_ee, X=x, H=h, stack=s)
msg = ic.safe_ur_move(c, Pose=dict(wp.home_joints), CMD=2)
if task == "ls":
model = fd.import_file("example.txt")
bricks = fd.decode_file(model)
#tic = time.time()
que, opt, p = ass.sort_bricks_ass(bricks, copy.deepcopy(model))
#print "sort time = ", time.time()-tic
#print "Sort output: ", opt
#print "total cost = ",ass.list_cost(que,copy.deepcopy(model))
#print ""
#for i in range(0,len(que)):
# if que[i]['r'] == 0 or que[i]['r'] == 180:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',que[i]['ye'],', ',que[i]['xe']
# else:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',que[i]['xe'],', ',que[i]['ye']
#for i in range(0,len(que)):
# if que[i]['r'] == 0 or que[i]['r'] == 180:
# print que[i]['x'],', ',que[i]['y']+que[i]['p'],', ',que[i]['z'],', ',que[i]['ye'],', ',que[i]['xe']
# else:
# print que[i]['x']+que[i]['p'],', ',que[i]['y'],', ',que[i]['z'],', ',que[i]['xe'],', ',que[i]['ye']
#ipt = raw_input("continue?")
#tic = time.time()
#delay = lm.assemble(c,ser_ee,que)
#tock = time.time()
print "----------- assembly prob ----------"
print " ", p * 100, '%'
print "----------- assembly time ----------"
print " ", 14.8 * len(que)
#ipt = raw_input("continue?")
#model = fd.import_file("example.txt")
#bricks = fd.decode_file(model)
#tic = time.time()
que, opt = dis.sort_bricks_dis(bricks, copy.deepcopy(model))
#print "dis time = ", time.time()-tic
print "Sort output: ", opt
#print "total cost = ",ass.list_cost(que,copy.deepcopy(model))
#for i in range(0,len(que)):
# if que[i]['r'] == 0 or que[i]['r'] == 180:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',que[i]['ye'],', ',que[i]['xe']
# else:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',que[i]['xe'],', ',que[i]['ye']
#tic1 = time.time()
#lm.disassemble(c,ser_ee,que)
#toc1 = time.time()
if opt == 'y':
print "--------- disassembly prob --------"
print " ", (0.999**len(que)) * 100, '%'
if opt == 'n':
print "--------- disassembly prob ---------"
print " ", 0, '%'
print "--------- disassembly time --------"
print " ", 20.8 * len(que)
print ""
print ""
print ""
print ""
if task == "lsflex":
model = fd.import_file("example.txt")
bricks = fd.decode_file(model)
flex, updated_model, opt = flx.sort_bricks_flex(bricks, model)
que, opt, p = ass.sort_bricks_ass(flex,
copy.deepcopy(updated_model))
print "----------- assembly prob ----------"
print " ", p * 100, '%'
print "----------- assembly time ----------"
print " ", 14.8 * len(que)
que, opt = dis.sort_bricks_dis(flex, copy.deepcopy(updated_model))
if opt == 'y':
print "--------- disassembly prob --------"
print " ", (0.999**len(que)) * 100, '%'
if opt == 'n':
print "--------- disassembly prob ---------"
print " ", 0, '%'
print "--------- disassembly time --------"
print " ", 20.8 * len(que)
print ""
print ""
print ""
print ""
if task == "re":
model1 = fd.import_file("example.txt")
bricks1 = fd.decode_file(model1)
model2 = fd.import_file("examplere.txt")
bricks2 = fd.decode_file(model2)
dis_list, ass_list = rea.reassemble(bricks1, bricks2, model1,
model2)
#print "dis_list :",dis_list
#print "as_list :",ass_list
#ipt = raw_input("continue?")
que, opt = dis.sort_bricks_dis(dis_list, copy.deepcopy(model1))
print "disassembly sort output: ", opt
print "-------------- remove --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z']
ipt = raw_input("continue?")
lm.disassemble(c, ser_ee, que)
print ""
print ""
que, opt = ass.sort_bricks_ass(ass_list, copy.deepcopy(model2))
print "assembly sort output: ", opt
print "-------------- build --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z", ",", " ex", ",", " ey"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i][
'z'], ', ', -que[i]['ye'], ', ', que[i]['xe']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', que[
i]['xe'], ', ', que[i]['ye']
ipt = raw_input("continue?")
lm.assemble(c, ser_ee, que)
if task == 'flex':
ipt = int(raw_input("model1?"))
if ipt == 1:
model = fd.import_file("model1.txt")
elif ipt == 2:
model = fd.import_file("model2.txt")
elif ipt == 3:
model = fd.import_file("model3.txt")
elif ipt == 4:
model = fd.import_file("model4.txt")
elif ipt == 5:
model = fd.import_file("model5.txt")
elif ipt == 6:
model = fd.import_file("model6.txt")
bricks = fd.decode_file(model)
que, updated_model, opt = flx.sort_bricks_flex(bricks, model)
print "flex sort output: ", opt
print "-------------- build --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z", ",", "ex", ",", "ey", ",", " b"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', -que[
i]['ye'], ', ', que[i]['xe'], ', ', que[i]['b']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', que[
i]['xe'], ', ', que[i]['ye'], ', ', que[i]['b']
ipt = raw_input("continue?")
que, opt = ass.sort_bricks_ass(que, copy.deepcopy(updated_model))
print "assembly sort output: ", opt
print "-------------- build --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z", ",", "ex", ",", "ey", ",", " b"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', -que[
i]['ye'], ', ', que[i]['xe'], ', ', que[i]['b']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', que[
i]['xe'], ', ', que[i]['ye'], ', ', que[i]['b']
print ass.list_cost(que, updated_model)
ipt = raw_input("continue?")
tic = time.time()
delay = lm.assemble(c, ser_ee, que)
tock = time.time()
print "----------- assembly time ----------"
print " ", tock - tic - delay
print "------------- resources ------------"
print " ", len(que)
#que,opt = dis.sort_bricks_dis(que,copy.deepcopy(updated_model))
#print "disassembly sort output: ",opt
#print "-------------- build --------------"
#print "x",","," y",","," p",","," r",","," z",",","ex",",","ey",","," b"
#for i in range(0,len(que)):
# if que[i]['r'] == 0 or que[i]['r'] == 180:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',-que[i]['ye'],', ',que[i]['xe'],', ',que[i]['b']
# else:
# print que[i]['x'],', ',que[i]['y'],', ',que[i]['p'],', ',que[i]['r'],', ',que[i]['z'],', ',que[i]['xe'],', ',que[i]['ye'],', ',que[i]['b']
#ipt = raw_input("continue?")
#lm.disassemble(c,ser_ee,que)
if task == "reflex":
ipt = int(raw_input("model1?"))
if ipt == 1:
model1 = fd.import_file("model1.txt")
model2 = fd.import_file("model2.txt")
elif ipt == 2:
model1 = fd.import_file("model2.txt")
model2 = fd.import_file("model3.txt")
elif ipt == 3:
model1 = fd.import_file("model3.txt")
model2 = fd.import_file("model4.txt")
elif ipt == 4:
model1 = fd.import_file("model4.txt")
model2 = fd.import_file("model5.txt")
elif ipt == 5:
model1 = fd.import_file("model5.txt")
model2 = fd.import_file("model6.txt")
bricks1 = fd.decode_file(model1)
#print "1 length: ", len(bricks1)
bricks2 = fd.decode_file(model2)
#print "2 length: ", len(bricks2)
flex1, updated_model1, opt1 = flx.sort_bricks_flex(bricks1, model1)
flex2, updated_model2, opt2 = flx.sort_bricks_flex(bricks2, model2)
dis_list, ass_list = rea.reassemble(flex1, flex2, updated_model1,
updated_model2)
print "dis_list :", dis_list
print "as_list :", ass_list
ipt = raw_input("continue?")
que, opt = dis.sort_bricks_dis(dis_list,
copy.deepcopy(updated_model1))
print "disassembly sort output: ", opt
print "-------------- remove --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z']
ipt = raw_input("continue?")
tic1 = time.time()
lm.disassemble(c, ser_ee, que)
toc1 = time.time()
bricks_saved = len(que)
#print "dis length: ", bricks_saved
#print ""
#print ""
que, opt = ass.sort_bricks_ass(ass_list,
copy.deepcopy(updated_model2))
#print "ass length: ", len(que)
#print "P(success): ",p
#print ""
print "assembly sort output: ", opt
print "-------------- build --------------"
print "x", ",", " y", ",", " p", ",", " r", ",", " z", ",", " ex", ",", " ey"
for i in range(0, len(que)):
if que[i]['r'] == 0 or que[i]['r'] == 180:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i][
'z'], ', ', -que[i]['ye'], ', ', que[i]['xe']
else:
print que[i]['x'], ', ', que[i]['y'], ', ', que[i][
'p'], ', ', que[i]['r'], ', ', que[i]['z'], ', ', que[
i]['xe'], ', ', que[i]['ye']
ipt = raw_input("continue?")
tic2 = time.time()
delay = lm.assemble(c, ser_ee, que)
toc2 = time.time()
print "---------- reassembly time ---------"
print " ", toc2 - tic2 - delay + toc1 - tic1
print "------------- resources ------------"
print " ", len(que) - bricks_saved
if task == 'time':
tic = time.time()
ipt = raw_input("Refill hopper and press enter to continue")
toc = time.time()
print toc - tic
if task == 'gol':
nbricks = int(raw_input("Number of starting bricks: "))
iter = int(raw_input("Number of iterations: "))
gol.game_of_life(c, ser_ee, nbricks, iter)