The math and code to triangulate the XYZ position and orientation of four photodiodes using the HTC Lighthouse V1 infrared beacons and a Teensy 3.