Adds EPnP algorithm