19 class IVisualization3D;
25 double locErrorScale,
const ViewConfig& viewConfig) {
32 ellipse.push_back(transform *
35 Polyhedron ellipseHedron(ellipse, faces.first, faces.second);
42 double angularErrorScale,
const ViewConfig& viewConfig) {
43 auto [
lambda0, lambda1,
theta] = decomposeCovariance(covariance);
46 Vector3 anker = position + directionScale * direction;
56 std::vector<Vector3> ellipse =
57 createEllipse(angularErrorScale * directionScale *
lambda0 * sin(dtheta),
58 angularErrorScale * directionScale * lambda1,
theta,
59 viewConfig.
nSegments, 0., {0., 0.}, eplane);
61 std::vector<Vector3> coneTop = ellipse;
62 coneTop.push_back(anker);
64 Polyhedron coneTopHedron(coneTop, coneTopFaces.first, coneTopFaces.second);
67 std::vector<Vector3> cone = ellipse;
73 Polyhedron coneHedron(cone, coneFaces.first, coneFaces.second);