00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023 inline
00024 Vector3 RigidModel::ComputeVertexNormal(FeatureId id) const {
00025
00026
00027 }
00028
00029 inline
00030 Vector3 RigidModel::ComputeFaceNormal(FeatureId id) const {
00031
00032
00033 Face f = m_faces[id];
00034
00035 Vector3 v0 = m_vertices[f.m_v0];
00036 Vector3 v1 = m_vertices[f.m_v1];
00037 Vector3 v2 = m_vertices[f.m_v2];
00038
00039 return ((v1 - v0) ^ (v2 - v0)).Normalized();
00040 }
00041
00042 inline
00043 bool RigidModel::ArePointsSameSide(const Vector3 &p1, const Vector3 &p2,
00044 const Vector3 &v0, const Vector3 &v1)
00045 {
00046 return ((v1 - v0) ^ (p1 - v0)) * ((v1 - v0) ^ (p2 - v0)) >= 0;
00047 }
00048
00049 inline
00050 bool RigidModel::IsPointInTriangle(const Vector3 &p, const Vector3 &v0,
00051 const Vector3 &v1, const Vector3 &v2)
00052 {
00053 return
00054 ArePointsSameSide(p, v0, v1, v2) &&
00055 ArePointsSameSide(p, v1, v0, v2) &&
00056 ArePointsSameSide(p, v2, v0, v1);
00057 }