qadmesh affine transform parenting

This commit is contained in:
AndreaRigoni
2026-03-19 12:54:31 +00:00
parent 887b3b36f0
commit 4cb4560921
9 changed files with 103 additions and 33 deletions

View File

@@ -35,10 +35,10 @@ void QuadMesh::PrintSelf(std::ostream &o)
o << " #Quads : " << m_Quads.size() << "\n";
for(int i=0; i < m_Quads.size(); ++i ) {
o << " - quad[" << i << "]" <<
" " << m_Quads[i](0) << "->(" << m_Points[m_Quads[i](0)].transpose() << ") " <<
" " << m_Quads[i](1) << "->(" << m_Points[m_Quads[i](1)].transpose() << ") " <<
" " << m_Quads[i](2) << "->(" << m_Points[m_Quads[i](2)].transpose() << ") " <<
" " << m_Quads[i](3) << "->(" << m_Points[m_Quads[i](3)].transpose() << ") " <<
" " << m_Quads[i](0) << "->(" << GetPoint(m_Quads[i](0)).transpose() << ") " <<
" " << m_Quads[i](1) << "->(" << GetPoint(m_Quads[i](1)).transpose() << ") " <<
" " << m_Quads[i](2) << "->(" << GetPoint(m_Quads[i](2)).transpose() << ") " <<
" " << m_Quads[i](3) << "->(" << GetPoint(m_Quads[i](3)).transpose() << ") " <<
" \n";
}
o << " // ------------------------- // \n";
@@ -46,7 +46,16 @@ void QuadMesh::PrintSelf(std::ostream &o)
void QuadMesh::AddPoint(const Vector3f &pt)
{
this->m_Points.push_back(pt);
Vector4f p(pt.x(), pt.y(), pt.z(), 1.0f);
Vector4f localP = this->GetWorldMatrix().inverse() * p;
this->m_Points.push_back(localP.head<3>());
}
Vector3f QuadMesh::GetPoint(const Id_t id) const
{
Vector4f p(m_Points.at(id).x(), m_Points.at(id).y(), m_Points.at(id).z(), 1.0f);
Vector4f worldP = this->GetWorldMatrix() * p;
return worldP.head<3>();
}
void QuadMesh::AddQuad(const Id_t *id)
@@ -63,9 +72,9 @@ void QuadMesh::AddQuad(const Vector4i &id)
Vector3f QuadMesh::GetNormal(const Id_t id) const
{
const Vector4i &quad = m_Quads.at(id);
const Vector3f &v0 = m_Points.at(quad(0));
const Vector3f &v1 = m_Points.at(quad(1));
const Vector3f &v3 = m_Points.at(quad(3));
const Vector3f v0 = this->GetPoint(quad(0));
const Vector3f v1 = this->GetPoint(quad(1));
const Vector3f v3 = this->GetPoint(quad(3));
Vector3f edge1 = v1 - v0;
Vector3f edge2 = v3 - v0;