|
|
@@ -0,0 +1,111 @@
|
|
|
+#include "bone_visible.h"
|
|
|
+#include "EmbreeIntersector.h"
|
|
|
+#include <igl/project_to_line.h>
|
|
|
+#include <igl/EPS.h>
|
|
|
+#include <iostream>
|
|
|
+
|
|
|
+template <
|
|
|
+ typename DerivedV,
|
|
|
+ typename DerivedF,
|
|
|
+ typename DerivedSD,
|
|
|
+ typename Derivedflag>
|
|
|
+void bone_visible(
|
|
|
+ const Eigen::PlainObjectBase<DerivedV> & V,
|
|
|
+ const Eigen::PlainObjectBase<DerivedF> & F,
|
|
|
+ const Eigen::PlainObjectBase<DerivedSD> & s,
|
|
|
+ const Eigen::PlainObjectBase<DerivedSD> & d,
|
|
|
+ Eigen::PlainObjectBase<Derivedflag> & flag)
|
|
|
+{
|
|
|
+ using namespace igl;
|
|
|
+ using namespace std;
|
|
|
+ using namespace Eigen;
|
|
|
+ flag.resize(V.rows());
|
|
|
+ // Initialize intersector
|
|
|
+ const EmbreeIntersector<MatrixXd,MatrixXi,Vector3d> ei =
|
|
|
+ EmbreeIntersector<MatrixXd,MatrixXi,Vector3d>(V,F);
|
|
|
+ const double sd_norm = (s-d).norm();
|
|
|
+ // loop over mesh vertices
|
|
|
+ // TODO: openmp?
|
|
|
+ for(int v = 0;v<V.rows();v++)
|
|
|
+ {
|
|
|
+ Vector3d Vv = V.row(v);
|
|
|
+ // Project vertex v onto line segment sd
|
|
|
+ //embree.intersectSegment
|
|
|
+ double t,sqrd;
|
|
|
+ Vector3d projv;
|
|
|
+ // degenerate bone, just snap to s
|
|
|
+ if(sd_norm < DOUBLE_EPS)
|
|
|
+ {
|
|
|
+ t = 0;
|
|
|
+ sqrd = (Vv-s).array().pow(2).sum();
|
|
|
+ projv = s;
|
|
|
+ }else
|
|
|
+ {
|
|
|
+ // project onto (infinite) line
|
|
|
+ project_to_line(
|
|
|
+ Vv(0),Vv(1),Vv(2),s(0),s(1),s(2),d(0),d(1),d(2),
|
|
|
+ projv(0),projv(1),projv(2),t,sqrd);
|
|
|
+ // handle projections past endpoints
|
|
|
+ if(t<0)
|
|
|
+ {
|
|
|
+ t = 0;
|
|
|
+ sqrd = (Vv-s).array().pow(2).sum();
|
|
|
+ projv = s;
|
|
|
+ } else if(t>1)
|
|
|
+ {
|
|
|
+ t = 1;
|
|
|
+ sqrd = (Vv-d).array().pow(2).sum();
|
|
|
+ projv = d;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ embree::Hit hit;
|
|
|
+ // perhaps 1.0 should be 1.0-epsilon, or actually since we checking the
|
|
|
+ // incident face, perhaps 1.0 should be 1.0+eps
|
|
|
+ const Vector3d dir = (Vv-projv)*1.0;
|
|
|
+ if(ei.intersectSegment(projv,dir, hit))
|
|
|
+ {
|
|
|
+ //if(v == 1228-1)
|
|
|
+ //{
|
|
|
+ // int fi = hit.id0;
|
|
|
+ // Vector3d bc,P;
|
|
|
+ // bc << 1 - hit.u - hit.v, hit.u, hit.v; // barycentric
|
|
|
+ // P = V.row(F(fi,0))*bc(0) +
|
|
|
+ // V.row(F(fi,1))*bc(1) +
|
|
|
+ // V.row(F(fi,2))*bc(2);
|
|
|
+ // cout<<(fi+1)<<endl;
|
|
|
+ // cout<<bc.transpose()<<endl;
|
|
|
+ // cout<<P.transpose()<<endl;
|
|
|
+ // cout<<Vv.transpose()<<endl;
|
|
|
+ //}
|
|
|
+
|
|
|
+ const int fi = hit.id0; // face id
|
|
|
+ // Assume hit is valid, so not visible
|
|
|
+ flag(v) = false;
|
|
|
+ // loop around corners of triangle
|
|
|
+ for(int c = 0;c<F.cols();c++)
|
|
|
+ {
|
|
|
+ if(F(fi,c) == v)
|
|
|
+ {
|
|
|
+ // hit self, so no hits before, so vertex v is visible
|
|
|
+ flag(v) = true;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ // Hit is actually past v
|
|
|
+ if(!flag(v) && (hit.t*hit.t*dir.squaredNorm())>sqrd)
|
|
|
+ {
|
|
|
+ flag(v) = true;
|
|
|
+ }
|
|
|
+ }else
|
|
|
+ {
|
|
|
+ // no hit so vectex v is visible
|
|
|
+ flag(v) = true;
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+#ifndef IGL_HEADER_ONLY
|
|
|
+// Explicit template instanciation
|
|
|
+template void bone_visible<Eigen::Matrix<double, -1, -1, 0, -1, -1>, Eigen::Matrix<int, -1, -1, 0, -1, -1>, Eigen::Matrix<double, 3, 1, 0, 3, 1>, Eigen::Matrix<bool, -1, 1, 0, -1, 1> >(Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<int, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, 3, 1, 0, 3, 1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, 3, 1, 0, 3, 1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<bool, -1, 1, 0, -1, 1> >&);
|
|
|
+template void bone_visible<Eigen::Matrix<double, -1, -1, 0, -1, -1>, Eigen::Matrix<int, -1, -1, 0, -1, -1>, Eigen::Matrix<double, -1, 1, 0, -1, 1>, Eigen::Matrix<bool, -1, 1, 0, -1, 1> >(Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<int, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, -1, 1, 0, -1, 1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, -1, 1, 0, -1, 1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<bool, -1, 1, 0, -1, 1> >&);
|
|
|
+#endif
|
Alec Jacobson (jalec