TPROF5 = tps2
if (boxes[i].neighbors.size == 8):
break
delta = datetime.datetime.now() - tstart
print("Neighbors. Time " + str(delta.seconds) + "." + str(delta.microseconds))
#for i in range(boxes.size):
# boxes[i].printbox()
x1 = 2.2
y1 = 0.5
x2 = 1.2
y2 = 0.9
trajectory = di.trajectory_search(boxes, x1, y1, x2, y2)
#trajectory = np.array([])
#dr.draw(boxes, trajectory, singularity)
dr.draw(boxes, trajectory, singularity)
#dr.draw(boxes, np.array([]), singularity)
#dr.draw(boxes, np.array([]), np.array([]))
print("Left -> Right")
x1 = 1.1
y1 = 0.8
x2 = 2.0
y2 = 0.8
trajectory = di.trajectory_search(boxes, x1, y1, x2, y2)
dr.draw(boxes, trajectory, singularity)
if (boxes[i].is_neighbor(boxes[j])):
boxes[i].add_neighbor(boxes[j])
boxes[j].add_neighbor(boxes[i])
ncycle += 1
if (ncycle%1000000 == 0):
tps2 = datetime.datetime.now()
delta_all = tps2 - TPROF4
delta1000 = tps2 - TPROF5
print("C: " + str(ncycle) + "; " + str(i) + ":" + str(j) + "; d1000: " + str(delta1000.seconds) + "; all: " + str(delta_all.seconds))
TPROF5 = tps2
#for i in range(boxes.size):
# boxes[i].printbox(area.EPSILON, area.ANGLE)
tstart = datetime.datetime.now()
trajectory = di.trajectory_search(boxes, x1, y1, p1, x2, y2, p2)
delta = datetime.datetime.now() - tstart
print("Trajectory time1: " + str(delta.seconds) + "." + str(delta.microseconds))
tstart = datetime.datetime.now()
d3.draw(boxes, trajectory)
#dr.draw(boxes, trajectory, singularity)
#dr.draw(boxes, trajectory, np.array([]))
#dr.draw(boxes, np.array([]), singularity)
#dr.draw(boxes, np.array([]), np.array([]))
delta = datetime.datetime.now() - tstart
print("Print time: " + str(delta.seconds) + "." + str(delta.microseconds))