poikilos / b3view Goto Github PK

/**
 * Calculate the UV point based on collision data (triangle and point) that you've already
 * obtained using irrlicht's CollisionManager and TriangleSelector.
 * 
 * Attribution-ShareAlike 3.0 Unported [CC BY SA 3.0](https://creativecommons.org/licenses/by-sa/3.0/)
 * [Imm0](https://stackoverflow.com/users/1242688/imm0) and
 * [Matt Fenwick](https://stackoverflow.com/users/894284/matt-fenwick).
 * <https://stackoverflow.com/a/9516602>
 *
 * @param tri Check this triangle (get this via CollisionManager and TriangleSelector)
 * @param p Check this point (CollisionManager and TriangleSelector)
 * @param pMeshNode This is the mesh you have chosen beforehand and on which you've calculated the triangle and collision point.
 * @param pDriver Provide the current video driver.
 * @return The 2D point on the texture in UV coordinates.
 */
irr::core::vector2df getPointUV(irr::core::triangle3df tri, irr::core::vector3df p, irr::scene::IMeshSceneNode* pMeshNode, irr::video::IVideoDriver* pDriver)
{
    irr::core::matrix4 inverseTransform(
    pMeshNode->getAbsoluteTransformation(),
      irr::core::matrix4::EM4CONST_INVERSE);

    inverseTransform.transformVect(tri.pointA);
    inverseTransform.transformVect(tri.pointB);
    inverseTransform.transformVect(tri.pointC);

    irr::core::vector3df 
    v0 = tri.pointC - tri.pointA,
    v1 = tri.pointB - tri.pointA,
    v2 = p - tri.pointA;

    float dot00 = v0.dotProduct(v0),
    dot01 = v0.dotProduct(v1),
    dot02 = v0.dotProduct(v2),
    dot11 = v1.dotProduct(v1),
    dot12 = v1.dotProduct(v2);

    float invDenom = 1.f / ((dot00 * dot11) - (dot01 * dot01)),
    u = (dot11 * dot02 - dot01 * dot12) * invDenom,
    v = (dot00 * dot12 - dot01 * dot02) * invDenom;

    irr::video::S3DVertex A, B, C;
    irr::video::S3DVertex* vertices = static_cast<irr::video::S3DVertex*>(
      pMeshNode->getMesh()->getMeshBuffer(0)->getVertices());

    for(unsigned int i=0; i < pMeshNode->getMesh()->getMeshBuffer(0)->getVertexCount(); ++i)
    {
      if( vertices[i].Pos == tri.pointA)
      {
        A = vertices[i];
      }
      else if( vertices[i].Pos == tri.pointB)
      {
        B = vertices[i];
      }
      else if( vertices[i].Pos == tri.pointC)
      {
        C = vertices[i];
      }
    }

    irr::core::vector2df t2 = B.TCoords - A.TCoords;
    irr::core::vector2df t1 = C.TCoords - A.TCoords;

    irr::core::vector2df uvCoords = A.TCoords + t1*u + t2*v;

    return uvCoords;
}