image_points_altered[2] = (image_points[4][0],
image_points[4][1])
image_points_altered[4] = (image_points[3][0],
image_points[3][1])
else:
logger.error("Invalid pentagon shape")
image_points_altered[2] = (image_points[2][0],
image_points[2][1])
image_points_altered[3] = (image_points[3][0],
image_points[3][1])
image_points_altered[4] = (image_points[4][0],
image_points[4][1])
image_points = np.array(image_points_altered)
print("Sorted altered points", image_points)
m1.set_number_of_lights(len(image_points))
m2.set_number_of_lights(len(image_points))
if contour5_flag == True:
print("entered")
# Camera internals
size = image.shape
#focal_length = size[1]
#center = (size[1]/2, size[0]/2)
focal_length = 780
center = (479.72, 104.56)
camera_matrix = np.array(
[[768.31, 0, center[0]], [0, 768.21, center[1]], [0, 0, 1]],
dtype="double")
