public static void CollideBox(GameObject physObject1, GameObject physObject2)
{
PointFloat vel1 = physObject1.GetVelocity();
PointFloat vel2 = physObject2.GetVelocity();
float h1 = -(float)Math.Atan2(vel1.x, vel1.y);
float h2 = -(float)Math.Atan2(vel2.x, vel2.y);
if (h2 > h1 + (_pi / 2.0f) && h2 < h1 - (_pi / 2.0f))
{
return;
}
PointFloat pos1 = physObject1.GetPosition();
PointFloat pos2 = physObject2.GetPosition();
float x = pos1.x - pos2.x;
float y = pos1.y - pos2.y;
float h = -(float)Math.Atan2(x, y);
PointFloat dir = GetDirection(h + (float)Math.PI / 2.0f);
float e1 = (Math.Abs(vel1.x) + Math.Abs(vel2.x)) * dir.x;
float e2 = (Math.Abs(vel1.y) + Math.Abs(vel2.y)) * dir.y;
e1 = e1 / 2;
e2 = e2 / 2;
if (!physObject1.OnColision(physObject2, e1 + e2))
{
return;
}
int count = 0;
while (count <= 10 && IsInBox(physObject1.GetPosition(), physObject2.GetPosition(), physObject1.GetSize(), physObject2.GetSize()))
{
if (vel1.GetSpeed() < vel2.GetSpeed())
{
physObject2.SetPosAdd(vel2 / -10);
}
else
{
physObject1.SetPosAdd(vel1 / 10);
}
count++;
}
if (physObject2.HasMass() == true)
{
physObject1.SetVelocity(0, 0);
}
if (physObject1.HasMass() == true)
{
physObject2.SetVelocity(0, 0);
}
PhysInteractions++;
}
public static PointFloat[] RectPoint(PointFloat pos, PointFloat size, float t)
{
PointFloat[] res = new PointFloat[4];
//res[0] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(-45)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(-45)) * size.y));
//res[1] = new PointFloat(pos.x + (float)( Math.Cos(-t + DegreeToRad(45)) * size.x ), pos.y + (float)( Math.Sin(-t + DegreeToRad(45)) * size.y ));
//res[2] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(135)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(135)) * size.y));
//res[3] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(225)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(225)) * size.y));
for (int i = 0; i < res.Length; i++)
{
res[i] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(-45 + 90 * i)) * size.x) * 1.41421359f, pos.y + (float)(Math.Sin(-t + DegreeToRad(-45 + 90 * i)) * size.y) * 1.41421359f);
//res[i] = new PointFloat((pos.x * (float)Math.Cos(t + DegreeToRad(-45 + 90 * i)) - pos.y * (float)Math.Sin(t + DegreeToRad(-45 + 90 * i))) /10.0f,
// (pos.x * (float)Math.Cos(t + DegreeToRad(-45 + 90 * i)) + pos.y * (float)Math.Sin(t + DegreeToRad(-45 + 90 * i))) / 10.0f);
}
return(res);
}
public static bool IsOverlappingInCircle(GameObject physObject1, GameObject physObject2)
{
PointFloat physPos = physObject1.GetPosition();
float physSize = physObject1.GetPhysSize();
if (physObject2.HasPhysics() && !(physObject2.IsParticle() && physObject2.Type == physObject1.Type))
{
PointFloat objPos = physObject2.GetPosition();
float fDistance = (float)(Math.Pow(physPos.x - objPos.x, 2) + Math.Pow(physPos.y - objPos.y, 2));
if (fDistance < physSize + physObject2.GetPhysSize())
{
return(true);
}
}
return(false);
}
//handles collision
public static void CollideCircleBox(GameObject physObject1, GameObject physObject2)
{
PointFloat vel1 = physObject1.GetVelocity();
PointFloat vel2 = physObject2.GetVelocity();
float h1 = -(float)Math.Atan2(vel1.x, vel1.y);
float h2 = -(float)Math.Atan2(vel2.x, vel2.y);
if (h2 > h1 + (_pi / 2.0f) && h2 < h1 - (_pi / 2.0f))
{
return;
}
PointFloat pos1 = physObject1.GetPosition();
PointFloat pos2 = physObject2.GetPosition();
float x = pos1.x - pos2.x;
float y = pos1.y - pos2.y;
float h = -(float)Math.Atan2(x, y);
PointFloat dir = GetDirection(h + (float)Math.PI / 2.0f);
//while ( IsOverlappingInCircle(physObject1, physObject2) )
//{
//physObject1.SetPosAdd(dir / 1);
//physObject2.SetPosAdd(dir / -1);
//}
float e1 = (Math.Abs(vel1.x) + Math.Abs(vel2.x)) * dir.x;
float e2 = (Math.Abs(vel1.y) + Math.Abs(vel2.y)) * dir.y;
e1 = e1 / 2;
e2 = e2 / 2;
if (!physObject1.OnColision(physObject2, e1 + e2))
{
return;
}
if (physObject2.HasMass() == true)
{
physObject1.SetPosAdd(vel1 / -1);
physObject1.SetVelocity(e1, e2);
physObject1.SetRotationVelocity(((float)Math.Atan2(vel1.x + vel2.x, vel1.y + vel2.y) - (float)Math.Atan2(x, y)) / 100f);
}
if (physObject1.HasMass() == true)
{
physObject2.SetVelocity(-e1, -e2);
physObject2.SetRotationVelocity(((float)Math.Atan2(vel1.x + vel2.x, vel1.y + vel2.y) - (float)Math.Atan2(x, y)) / 100f);
}
PhysInteractions++;
}
//is colliding
public static bool IsOverlappingInCircle(GameObject physObject)
{
PointFloat physPos = physObject.GetPosition();
float physSize = physObject.GetPhysSize();
foreach (GameObject obj in TomatoMainEngine.GameObjects)
{
if (obj.HasPhysics() && !(obj.IsParticle() && obj.Type == physObject.Type) && obj != physObject)
{
float fDistance = (float)(Math.Pow(physPos.x - obj.GetPosition().x, 2) + Math.Pow(physPos.y - obj.GetPosition().y, 2));
if (fDistance < physSize + obj.GetPhysSize())
{
return(true);
}
}
}
return(false);
}
private static bool IsInBox(PointFloat pos1, PointFloat pos2, PointFloat size1, PointFloat size2)
{
if (Math.Abs(pos1.x - pos2.x) + Math.Abs(pos1.y - pos2.y) > 10)
{
//return false;
}
bool a = false;
PointFloat[] points1 = RenderLogics.RectPoint(pos1, size1, 0.0f);
PointFloat[] points2 = RenderLogics.RectPoint(pos2, size2, 0.0f);
foreach (PointFloat point1 in points1)
{
if (InRange(point1.x, points2[3].x, points2[1].x) && InRange(point1.y, points2[3].y, points2[1].y))
{
a = true;
}
}
return(a);
}
public static List <GameObject> GetAllOverlapping(GameObject physObject)
{
_tempList.Clear();
if (Mode == PhysMode.CircleBox)
{
PointFloat physPos = physObject.GetPosition();
float physSize = physObject.GetPhysSize();
foreach (GameObject obj in TomatoMainEngine.GameObjects)
{
if (obj.HasPhysics() && obj != physObject && !(physObject.IsParticle() && obj.Type == physObject.Type))
{
PointFloat objPos = obj.GetPosition();
float gemX = Math.Abs(objPos.x - physPos.x);
float gemY = Math.Abs(objPos.y - physPos.y);
float fDistance = gemX + gemY - obj.GetPhysSize();
if (fDistance < physSize)
{
_tempList.Add(obj);
}
}
}
}
else
{
PointFloat physPos = physObject.GetPosition();
PointFloat physSize = physObject.GetSize();
foreach (GameObject obj in TomatoMainEngine.GameObjects)
{
if (obj.HasPhysics() && obj != physObject && !(physObject.IsParticle() && obj.Type == physObject.Type))
{
if (IsInBox(physPos, obj.GetPosition(), physSize, obj.GetSize()))
{
_tempList.Add(obj);
}
}
}
}
return(_tempList);
}
public void SetVelocity(PointFloat velocity)
{
_vel.x = velocity.x;
_vel.y = velocity.y;
}
public void SetVelocityAdd(PointFloat velocity)
{
_vel.x = _vel.x + velocity.x;
_vel.y = _vel.y + velocity.y;
}
public void SetVelocity(PointFloat velocity)
{
_vel.x = velocity.x;
_vel.y = velocity.y;
}
public static void SetPos(PointFloat pos)
{
X = pos.x;
Y = pos.y;
}
public void SetSize(PointFloat size)
{
_size.x = size.x;
_size.y = size.y;
}
public static PointFloat[] RectPoint(PointFloat pos,PointFloat size, float t)
{
PointFloat[] res = new PointFloat[4];
//res[0] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(-45)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(-45)) * size.y));
//res[1] = new PointFloat(pos.x + (float)( Math.Cos(-t + DegreeToRad(45)) * size.x ), pos.y + (float)( Math.Sin(-t + DegreeToRad(45)) * size.y ));
//res[2] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(135)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(135)) * size.y));
//res[3] = new PointFloat(pos.x + (float)(Math.Cos(-t + DegreeToRad(225)) * size.x), pos.y + (float)(Math.Sin(-t + DegreeToRad(225)) * size.y));
for ( int i=0; i < res.Length; i++ )
{
res[i] = new PointFloat(pos.x + (float)( Math.Cos(-t + DegreeToRad(-45 + 90 * i)) * size.x ) * 1.41421359f, pos.y + (float)( Math.Sin(-t + DegreeToRad(-45 + 90 * i)) * size.y ) * 1.41421359f);
//res[i] = new PointFloat((pos.x * (float)Math.Cos(t + DegreeToRad(-45 + 90 * i)) - pos.y * (float)Math.Sin(t + DegreeToRad(-45 + 90 * i))) /10.0f,
// (pos.x * (float)Math.Cos(t + DegreeToRad(-45 + 90 * i)) + pos.y * (float)Math.Sin(t + DegreeToRad(-45 + 90 * i))) / 10.0f);
}
return res;
}
public void SetPosAdd(PointFloat add)
{
_pos.x = _pos.x + add.x;
_pos.y = _pos.y + add.y;
}
public void SetPos(PointFloat pos)
{
_pos.x = pos.x;
_pos.y = pos.y;
}
public void SetPosAdd(PointFloat add)
{
_pos.x = _pos.x + add.x;
_pos.y = _pos.y + add.y;
}
public void SetSize(PointFloat size)
{
_size.x = size.x;
_size.y = size.y;
}
public void SetVelocityAdd(PointFloat velocity)
{
_vel.x = _vel.x + velocity.x;
_vel.y = _vel.y + velocity.y;
}
public static void SetPos(PointFloat pos)
{
X = pos.x;
Y = pos.y;
}
private static bool IsInBox(PointFloat pos1, PointFloat pos2, PointFloat size1, PointFloat size2)
{
if (Math.Abs(pos1.x - pos2.x) + Math.Abs(pos1.y - pos2.y) > 10)
{
//return false;
}
bool a = false;
PointFloat[] points1 = RenderLogics.RectPoint(pos1,size1 , 0.0f);
PointFloat[] points2 = RenderLogics.RectPoint(pos2, size2, 0.0f);
foreach(PointFloat point1 in points1){
if (InRange(point1.x, points2[3].x, points2[1].x) && InRange(point1.y, points2[3].y, points2[1].y))
{
a = true;
}
}
return a;
}
public void SetPos(PointFloat pos)
{
_pos.x = pos.x;
_pos.y = pos.y;
}
