Shape processing temporarily commented out to allow the robot to run it without cv2