private void RotateVec(Fix64 rot)
{
for (int i = 0; i < vertexInit.Length; i++)
{
vertex[i] = Fix64Vector2.Rotate(vertexInit[i], -rot);
}
Forward = Fix64Vector2.Rotate(initForward, -rot);
}
internal void CalcCollisionDir(MGFObject mgfObject)
{
if (IsTrigger == true)
{
CollisionDir = Forward;
return;
}
Fix64Vector2[] vertexO = mgfObject.GetVertex();
Fix64Vector2 v1 = Fix64Vector2.Rotate(vertexO[0], -(Fix64)90);
Fix64Vector2 v2 = Fix64Vector2.Rotate(vertexO[1], -(Fix64)90);
Fix64Vector2 v3 = -v1;
Fix64Vector2 v4 = -v2;
Fix64Vector2 dir = GetPos() - mgfObject.GetPos();
Fix64 d1 = Fix64Vector2.Dot(v1, dir);
Fix64 d2 = Fix64Vector2.Dot(v2, dir);
Fix64 d3 = Fix64Vector2.Dot(v3, dir);
Fix64 d4 = Fix64Vector2.Dot(v4, dir);
Fix64Vector2 collisionDirVertical = vertexO[0] - vertexO[1];
Fix64Vector2 collisionDirHorizontal = vertexO[1] - vertexO[2];
if (d1 >= Fix64.Zero && d4 >= Fix64.Zero)
{
if (Fix64Vector2.Dot(collisionDirHorizontal, Forward) > Fix64.Zero)
{
CollisionDir = Forward;
}
else
{
if (Fix64Vector2.Dot(collisionDirVertical, Forward) > Fix64.Zero)
{
CollisionDir = collisionDirVertical;
}
else
{
CollisionDir = -collisionDirVertical;
}
}
}
else if (d1 >= Fix64.Zero && d2 >= Fix64.Zero)
{
if (Fix64Vector2.Dot(collisionDirVertical, Forward) < Fix64.Zero)
{
CollisionDir = Forward;
}
else
{
if (Fix64Vector2.Dot(collisionDirHorizontal, Forward) > Fix64.Zero)
{
CollisionDir = collisionDirHorizontal;
}
else
{
CollisionDir = -collisionDirHorizontal;
}
}
}
else if (d2 >= Fix64.Zero && d3 >= Fix64.Zero)
{
if (Fix64Vector2.Dot(collisionDirHorizontal, Forward) < Fix64.Zero)
{
CollisionDir = Forward;
}
else
{
if (Fix64Vector2.Dot(collisionDirVertical, Forward) > Fix64.Zero)
{
CollisionDir = collisionDirVertical;
}
else
{
CollisionDir = -collisionDirVertical;
}
}
}
else if (d3 >= Fix64.Zero && d4 >= Fix64.Zero)
{
if (Fix64Vector2.Dot(collisionDirVertical, Forward) > Fix64.Zero)
{
CollisionDir = Forward;
}
else
{
if (Fix64Vector2.Dot(collisionDirHorizontal, Forward) > Fix64.Zero)
{
CollisionDir = collisionDirHorizontal;
}
else
{
CollisionDir = -collisionDirHorizontal;
}
}
}
}