Measuring - Added a bunch of utility functions in Measure.hpp
This commit is contained in:
parent
bca8597712
commit
f051847ac6
3 changed files with 40 additions and 19 deletions
|
@ -633,11 +633,11 @@ MeasurementResult get_measurement(const SurfaceFeature& a, const SurfaceFeature&
|
|||
} else if (f1.get_type() == SurfaceFeatureType::Plane) {
|
||||
assert(f2.get_type() == SurfaceFeatureType::Plane);
|
||||
|
||||
const auto& [idx1, normal1, pt1] = f1.get_plane();
|
||||
const auto& [idx2, normal2, pt2] = f2.get_plane();
|
||||
const auto [idx1, normal1, pt1] = f1.get_plane();
|
||||
const auto [idx2, normal2, pt2] = f2.get_plane();
|
||||
double angle = 0.;
|
||||
|
||||
if (normal1.isApprox(normal2)) {
|
||||
if (are_parallel(normal1, normal2)) {
|
||||
// The planes are parallel, calculate distance.
|
||||
Eigen::Hyperplane<double, 3> plane(normal1, pt1);
|
||||
result.distance_infinite = std::make_optional(DistAndPoints{plane.absDistance(pt2), Vec3d::Zero(), Vec3d::Zero()});
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue