14 double locErrorScale,
const ViewConfig& viewConfig) {
18 lambda0 * locErrorScale, lambda1 * locErrorScale,
theta,
21 ellipse.push_back(transform *
24 Polyhedron ellipseHedron(ellipse, faces.first, faces.second);
31 double directionScale,
double angularErrorScale,
33 auto [lambda0, lambda1,
theta] = decomposeCovariance(covariance);
36 Vector3D anker = position + directionScale * direction;
46 std::vector<Vector3D> ellipse =
47 createEllipse(angularErrorScale * directionScale * tan(lambda0),
48 angularErrorScale * directionScale * tan(lambda1),
theta,
49 viewConfig.
nSegments, 0., {0., 0.}, eplane);
51 std::vector<Vector3D> coneTop = ellipse;
52 coneTop.push_back(anker);
54 Polyhedron coneTopHedron(coneTop, coneTopFaces.first, coneTopFaces.second);
57 std::vector<Vector3D> cone = ellipse;
63 Polyhedron coneHedron(cone, coneFaces.first, coneFaces.second);