apply different triangulate algo in beacon geometry

  • create beacon/geometry
  • apply triangulate algorithm from opencv and gtsam
Edited by Jiandong Chen