Changeset 1045 for cpp/frams/model/geometry/geometryutils.cpp

Timestamp:

12/11/20 20:23:42 (4 years ago)

Author:

oriona

Message:

Part of GeometryTestUtils? functions moved to GeometryUtils?.

File:

• cpp/frams/model/geometry/geometryutils.cpp (modified) (2 diffs)

cpp/frams/model/geometry/geometryutils.cpp

@@ -4 +4 @@
 
 #include "geometryutils.h"
-
 #include <math.h>
 
@@ -409 +408 @@
         return true;
 }
+
+void GeometryUtils::addAnchorToModel(Model &model)
+{
+    Part *part = model.addNewPart(Part::SHAPE_ELLIPSOID);
+
+    part->p = Pt3D(0);
+    part->scale = Pt3D(0.1);
+    part->vcolor = Pt3D(1.0, 0.0, 1.0);
+
+    addAxesToModel(Pt3D(0.5), Orient(Orient_1), Pt3D(0.0), model);
+}
+
+void GeometryUtils::addPointToModel(const Pt3D &markerLocation, Model &model)
+{
+    Part *anchor = model.getPart(0);
+    Part *part = model.addNewPart(Part::SHAPE_ELLIPSOID);
+
+    part->p = Pt3D(markerLocation);
+    part->scale = Pt3D(0.05);
+    part->vcolor = Pt3D(1.0, 1.0, 0.0);
+
+    model.addNewJoint(anchor, part, Joint::SHAPE_FIXED);
+}
+
+void GeometryUtils::addAxesToModel(const Pt3D &sizes, const Orient &axes, const Pt3D &center,
+                                   Model &model)
+{
+    Part *anchor = model.getPart(0);
+    Part *part;
+
+    part = model.addNewPart(Part::SHAPE_CUBOID);
+    part->scale = Pt3D(sizes.x, 0.05, 0.05);
+    part->setOrient(axes);
+    part->p = center;
+    part->vcolor = Pt3D(1.0, 0.0, 0.0);
+    model.addNewJoint(anchor, part, Joint::SHAPE_FIXED);
+
+    part = model.addNewPart(Part::SHAPE_CUBOID);
+    part->scale = Pt3D(0.05, sizes.y, 0.05);
+    part->setOrient(axes);
+    part->p = center;
+    part->vcolor = Pt3D(0.0, 1.0, 0.0);
+    model.addNewJoint(anchor, part, Joint::SHAPE_FIXED);
+
+    part = model.addNewPart(Part::SHAPE_CUBOID);
+    part->scale = Pt3D(0.05, 0.05, sizes.z);
+    part->setOrient(axes);
+    part->p = center;
+    part->vcolor = Pt3D(0.0, 0.0, 1.0);
+    model.addNewJoint(anchor, part, Joint::SHAPE_FIXED);
+}
+
+void GeometryUtils::mergeModels(Model &target, Model &source)
+{
+    Part *targetAnchor = target.getPart(0);
+    Part *sourceAnchor = source.getPart(0);
+
+    target.moveElementsFrom(source);
+
+    target.addNewJoint(targetAnchor, sourceAnchor, Joint::SHAPE_FIXED);
+}
+
+double frand(double from, double width)
+{
+    return from + width * ((rand() % 10000) / 10000.0);
+}
+
+void GeometryUtils::randomizePositionScaleAndOrient(Part *part)
+{
+    part->p = Pt3D(frand(1.5, 1.0), frand(1.5, 1.0), frand(1.5, 1.0));
+    part->scale = Pt3D(frand(0.1, 0.9), frand(0.1, 0.9), frand(0.1, 0.9));
+    part->setRot(Pt3D(frand(0.0, M_PI), frand(0.0, M_PI), frand(0.0, M_PI)));
+}