bug fixes with creating P from R and c, introducing reprojection error