/**
@def Verify if a point lies on a face
@param Point3f p - Coordinates of the point
@param FacePointer f - Pointer to the face
@return true if point p is on face f, false elsewhere.
*/
bool IsOnFace(Point3f p, CMeshO::FacePointer f){
//Compute vectors
Point3f a=f->V(0)->P();
Point3f b=f->V(2)->P();
Point3f c=f->V(1)->P();
Point3f v0 = c-a;
Point3f v1 = b-a;
Point3f v2 = p-a;
// Compute dot products
float dot00 = v0.dot(v0);
float dot01 = v0.dot(v1);
float dot02 = v0.dot(v2);
float dot11 = v1.dot(v1);
float dot12 = v1.dot(v2);
// Compute barycentric coordinates
float invDenom = 1 / (dot00 * dot11 - dot01 * dot01);
float u = (dot11 * dot02 - dot01 * dot12) * invDenom;
float v = (dot00 * dot12 - dot01 * dot02) * invDenom;
// Check if point is in triangle
if(math::Abs(u)<0) u=0;
if(math::Abs(v)<0) v=0;
return (u >= 0) && (v >= 0) && (u + v <=1);
}
void LandmarkCapturePlugin::drawFace(CMeshO::FacePointer fp, MeshModel &m, GLArea *gla, QPainter *p)
{
//glDepthMask(GL_FALSE);
//glDisable(GL_DEPTH_TEST);
//p->endNativePainting();
//p->save();
//p->setRenderHint(QPainter::TextAntialiasing);
//p->setPen(Qt::white);
//QFont qFont;
//qFont.setStyleStrategy(QFont::NoAntialias);
//qFont.setFamily("Helvetica");
//qFont.setPixelSize(12);
//p->setFont(qFont);
QString buf = QString("f%1\n (%3 %4 %5)").arg(tri::Index(m.cm,fp)).arg(tri::Index(m.cm,fp->V(0))).arg(tri::Index(m.cm,fp->V(1))).arg(tri::Index(m.cm,fp->V(2)));
Point3f c=Barycenter(*fp);
vcg::glLabel::render(p,c,buf);
for(int i=0;i<3;++i)
{
buf =QString("\nv%1:%2 (%3 %4 %5)").arg(i).arg(fp->V(i) - &m.cm.vert[0]).arg(fp->P(i)[0]).arg(fp->P(i)[1]).arg(fp->P(i)[2]);
if( m.hasDataMask(MeshModel::MM_VERTQUALITY) )
buf +=QString(" - Q(%1)").arg(fp->V(i)->Q());
if( m.hasDataMask(MeshModel::MM_WEDGTEXCOORD) )
buf +=QString("- uv(%1 %2) id:%3").arg(fp->WT(i).U()).arg(fp->WT(i).V()).arg(fp->WT(i).N());
if( m.hasDataMask(MeshModel::MM_VERTTEXCOORD) )
buf +=QString("- uv(%1 %2) id:%3").arg(fp->V(i)->T().U()).arg(fp->V(i)->T().V()).arg(fp->V(i)->T().N());
vcg::glLabel::render(p,fp->V(i)->P(),buf);
}
//p->drawText(QRect(0,0,gla->width(),gla->height()), Qt::AlignLeft | Qt::TextWordWrap, buf);
//p->restore();
//p->beginNativePainting();
}
/**
@def Compute the intersection of the segment from p1 to p2 and the face f
@param CoordType p1 - position of the first point
@param Coordtype p2 - position of the second point
@param Facepointer f - pointer to the face
@param CoordType int_point - intersection point this is a return parameter for the function.
@param FacePointer face - pointer to the new face
@return the intersection edge index if there is an intersection -1 elsewhere
Step
*/
int ComputeIntersection(CMeshO::CoordType p1,CMeshO::CoordType p2,CMeshO::FacePointer &f,CMeshO::FacePointer &new_f,CMeshO::CoordType &int_point){
CMeshO::CoordType v0=f->V(0)->P();
CMeshO::CoordType v1=f->V(1)->P();
CMeshO::CoordType v2=f->V(2)->P();
float dist[3];
Point3f int_points[3];
dist[0]=PSDist(p2,v0,v1,int_points[0]);
dist[1]=PSDist(p2,v1,v2,int_points[1]);
dist[2]=PSDist(p2,v2,v0,int_points[2]);
int edge=-1;
if(dist[0]<dist[1]){
if(dist[0]<dist[2]) edge=0;
else edge=2;
}else{
if(dist[1]<dist[2]) edge=1;
else edge=2;
}
CMeshO::VertexType* v;
if(Distance(int_points[edge],f->V(edge)->P())<Distance(int_points[edge],f->V((edge+1) % 3)->P())) v=f->V(edge);
else v=f->V((edge+1) % 3);
vcg::face::Pos<CMeshO::FaceType> p(f,edge,v);
new_f=f->FFp(edge);
if(new_f==f) return -1;
if(Distance(int_points[edge],v->P())<EPSILON){
p.FlipF();
CMeshO::FacePointer tmp_f=p.F();
int n_face=0;
while(tmp_f!=f){
p.FlipE();
p.FlipF();
tmp_f=p.F();
n_face++;
}
if(n_face!=0){
int r=(rand()%(n_face-1))+2;
for(int i=0;i<r;i++){
p.FlipE();
p.FlipF();
}
new_f=p.F();
}
}
int_point=GetSafePosition(int_points[edge],new_f);
return edge;
}