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")