26 namespace PrimitivesVisualization {
29 auto identity = std::make_shared<Transform3D>(Transform3D::Identity());
30 auto rectangle = std::make_shared<RectangleBounds>(10., 10.);
49 helper.
write(
"Primitives_Line");
69 helper.
write(
"Primitives_Arrows");
76 helper, *
plane,
gctx, Transform3D::Identity(), 72,
false, surfaceColor);
84 cov << s0 *
s0, r01 * s0 *
s1, r01 * s0 *
s1, s1 *
s1;
88 helper, lcentered, cov,
plane->transform(
gctx), {3}, 10., 72, errorColor);
90 helper.
write(
"Primitives_CartesianError");
96 helper, *
plane,
gctx, Transform3D::Identity(), 72,
false, surfaceColor);
99 errorColor = {250, 0, 0};
105 cov << s0 *
s0, r01 * s0 *
s1, r01 * s0 *
s1, s1 *
s1;
110 double directionScale = 5.;
113 helper,
origin, direction, cov, {3}, directionScale, 10., 72, errorColor);
116 helper,
origin + 0.5 * directionScale * direction,
117 origin + 1.2 * directionScale * direction, 0.02, 0.1, 5., 72,
120 helper.
write(
"Primitives_AngularError");