public ParticleWorld(int maxContacts, int iterations = 0)
{
this.registry = new ParticleForceRegistry();
this.particles = new List <Particle>();
this.contactGenerators = new List <IParticleContactGenerator>();
this.resolver = new ParticleContactResolver(iterations);
this.maxContacts = maxContacts;
contacts = new ParticleContact[maxContacts];
for (int i = 0; i < maxContacts; ++i)
{
contacts[i] = new ParticleContact();
}
calculateIterations = (iterations == 0);
}
public int addContact(ParticleContact[] contacts, int current, int limit)
{
int count = 0;
ParticleContact contact = contacts[current];
foreach (Particle p1 in particles)
{
foreach (Particle p2 in particles)
{
if (p2 != p1)
{
Vec3 particle1Pos = p1.Position;
Vec3 particle2Pos = p2.Position;
float rad1 = p1.Radius;
float rad2 = p2.Radius;
Vec3 contactTrace = particle1Pos - particle2Pos;
float distance = contactTrace.len();
if (distance < (rad1 + rad2))
{
contact.contactNormal = contactTrace.normal();
contact.particle1 = p1;
contact.particle2 = p2;
contact.penetration = (rad1 + rad2) - distance;
contact.restitution = 1.0f;
current++;
contact = contacts[current];
count++;
}
if (count >= limit)
{
return(count);
}
}
}
}
return(count);
}
public int addContact(ParticleContact[] contacts, int current, int limit)
{
int count = 0;
ParticleContact contact = contacts[current];
foreach (Particle p in particles)
{
float y = p.Position.y;
float x = p.Position.x;
if (y > 500.0f)
{
contact.contactNormal = new Vec3(0.0f, -1.0f, 0.0f);
contact.particle1 = p;
contact.particle2 = null;
contact.penetration = y - 500.0f;
contact.restitution = 0.4f;
current++;
contact = contacts[current];
count++;
}
if (y < 0.0f)
{
contact.contactNormal = new Vec3(0.0f, 1.0f, 0.0f);
contact.particle1 = p;
contact.particle2 = null;
contact.penetration = -y;
contact.restitution = 0.4f;
current++;
contact = contacts[current];
count++;
}
if (x > 700.0f)
{
contact.contactNormal = new Vec3(-1.0f, 0.0f, 0.0f);
contact.particle1 = p;
contact.particle2 = null;
contact.penetration = x - 700.0f;
contact.restitution = 0.7f;
current++;
contact = contacts[current];
count++;
}
if (x < 0.0f)
{
contact.contactNormal = new Vec3(1.0f, 0.0f, 0.0f);
contact.particle1 = p;
contact.particle2 = null;
contact.penetration = -x;
contact.restitution = 0.4f;
current++;
contact = contacts[current];
count++;
}
if (count >= limit)
{
return(count);
}
}
return(count);
}
