Changed triangulation interface to be homogeneous 3d point.

Change-Id: I8e78cf359ca6657105fae21f71da74f2fb59f467