Updated P3P. Fixed a few bugs and added an interface for normalized image coordinates