stereo_tri: Implement filtering points by triangulation error