Triangulation working. Needs cleaning, testing.