5 #include <RobotAPI/interface/ArViz/Elements.h>
6 #include <Inventor/nodes/SoCone.h>
7 #include <Inventor/nodes/SoCylinder.h>
8 #include <Inventor/nodes/SoSphere.h>
9 #include <Inventor/nodes/SoTranslation.h>
19 tr =
new SoTranslation;
21 transl =
new SoTranslation;
32 float coneHeight = element.width * 6.0f;
33 float coneBottomRadius = element.width * 2.5f;
34 float baseLength = element.length - coneHeight;
35 baseLength =
std::max(0.0f, baseLength);
37 tr->translation.setValue(0, baseLength * 0.5f, 0);
39 c->radius = element.width;
40 c->height = baseLength;
42 transl->translation.setValue(0, element.length * 0.5f, 0);
44 cone->bottomRadius.setValue(coneBottomRadius);
45 cone->height.setValue(coneHeight);