def pickup_b2():
ir.four(84.3)
ir.one(-70.8)
ir.three(22.1)
ir.two(69.4)
ir.five(91.3)
def pickup_w2():
ir.four(84.3)
ir.one(68.8)
ir.three(22.1)
ir.two(67.9)
ir.five(91.3)
def place_b2():
ir.four(81.4)
ir.one(-91.1)
ir.three(32.4)
ir.two(64.7)
ir.five(56.5)
def place_w2():
ir.four(78.4)
ir.one(87)
ir.three(38)
ir.two(58.5)
ir.five(56.5)
def start_pos_2():
ir.two(-21.8)
ir.one(-1.6)
ir.three(112.2)
ir.four(73.2)
ir.five(56.5)
def int_pos_2():
ir.two(22.4)
ir.one(91.9)
ir.three(95.2)
ir.four(61.4)
ir.five(56.5)
def pos24():
ir.one(-77)
ir.three(87)
ir.four(65.7)
ir.two(26.2)
def pos23():
ir.one(-63.8)
ir.three(135.3)
ir.four(62.3)
ir.two(-20.4)
def pos15():
ir.one(50.9)
ir.three(56.2)
ir.four(68.8)
ir.two(48.2)
def pos21():
ir.one(58.8)
ir.three(128.0)
ir.four(60.3)
ir.two(-7.2)
def pos20():
ir.one(71.7)
ir.three(76.7)
ir.four(68.5)
ir.two(36.5)
def pos19():
ir.one(-55)
ir.three(65.2)
ir.four(68.2)
ir.two(39.1)
def pos18():
ir.one(-35.6)
ir.three(107.8)
ir.four(55)
ir.two(8.4)
def pos17():
ir.one(-2.2)
ir.three(113.3)
ir.four(58.2)
ir.two(4.8)
def pos16():
ir.one(30.9)
ir.three(106.0)
ir.four(53.5)
ir.two(11.6)
filepath = "c:/Users/Asus/Documents/Prolog/data.txt"
board = []
b = 1
lastboard = ['-' for i in range(25)]
ir.open_port()
#pos={'0':p.pos0(),'1':p.pos1(),'2':p.pos2(),'3':p.pos3(),'4':p.pos4(),'5':p.pos5(),'6':p.pos6(),'7':p.pos7(),'8':p.pos8(),'9':p.pos9(),'10':p.pos10(),'11':p.pos11(),'12':p.pos12(),'13':p.pos13(),'14':p.pos14(),'15':p.pos15(),'16':p.pos16(),'17':p.pos17(),'18':p.pos18(),'19':p.pos19(),'20':p.pos20(),'21':p.pos21(),'22':p.pos22(),'23':p.pos23(),'24':p.pos24()}
p.start_pos_1()
#time.sleep(1)
p.start_pos_2()
#print(len(lastboard))
print(lastboard)
robot_1 = []
robot_2 = []
i = 0
'''
ir.two(5)
p.pickup_b2()
time.sleep(1)
ir.two(5)
p.pos24()
#time.sleep(1)
ir.five(56.5)
#ir.seven(-20)
time.sleep(1)
'''
def goto(i):
if (i == 0): p.pos0()
if (i == 1): p.pos1()
def pos22():
ir.one(-2.8)
ir.four(69.4)
ir.three(147.1)
ir.two(-37.8)