优化collision

This commit is contained in:
YHH
2020-06-15 08:46:38 +08:00
parent 246e9a9511
commit 7f8f1cf0d0
8 changed files with 132 additions and 7 deletions

View File

@@ -3,6 +3,8 @@ class DistanceConstraint extends Constraint {
public stiffness: number = 0;
public restingDistance: number = 0;
public tearSensitivity = Number.POSITIVE_INFINITY;
public shouldApproximateCollisionWithPoints: boolean;
public totalPointsToApproximateCollisionsWith = 5;
private _particleOne: Particle;
private _particleTwo: Particle;
@@ -28,11 +30,48 @@ class DistanceConstraint extends Constraint {
}
public handleCollisions(collidersWithLayers){
if (this.shouldApproximateCollisionWithPoints){
this.approximateCollisionWithPoints(collidersWithLayers)
return;
}
let minX = Math.min(this._particleOne.position.x, this._particleTwo.position.x);
let maxX = Math.max(this._particleOne.position.x, this._particleTwo.position.x);
let minY = Math.min(this._particleOne.position.y, this._particleTwo.position.y);
let maxY = Math.max(this._particleOne.position.y, this._particleTwo.position.y);
// DistanceConstraint._polygon.bounds = Rectangle.
DistanceConstraint._polygon.bounds = Rectangle.fromMinMax(minX, minY, maxX, maxY);
let midPoint: Vector2 = this.preparePolygonForCollisionChecks();
let colliders = Physics.boxcastBroadphase(DistanceConstraint._polygon.bounds, collidersWithLayers);
colliders.forEach(collider => {
});
}
private preparePolygonForCollisionChecks(){
let midPoint = Vector2.lerp(this._particleOne.position, this._particleTwo.position, 0.5);
DistanceConstraint._polygon.position = midPoint;
DistanceConstraint._polygon.points[0] = Vector2.subtract(this._particleOne.position, DistanceConstraint._polygon.position);
DistanceConstraint._polygon.points[1] = Vector2.subtract(this._particleTwo.position, DistanceConstraint._polygon.position);
DistanceConstraint._polygon.recalculateCenterAndEdgeNormals();
return midPoint;
}
private approximateCollisionWithPoints(collidersWithLayers: number){
let pt;
for (let j = 0; j < this.totalPointsToApproximateCollisionsWith - 1; j ++){
pt = Vector2.lerp(this._particleOne.position, this._particleTwo.position, (j + 1) / this.totalPointsToApproximateCollisionsWith);
let collidedCount = Physics.overlapCircleAll(pt, 3, VerletWorld.colliders, collidersWithLayers);
for (let i = 0; i < collidedCount; i ++){
let collider = VerletWorld.colliders[i];
let collisionResult: CollisionResult = collider.shape.pointCollidesWithShape(pt);
if (collisionResult){
this._particleOne.position = Vector2.subtract(this._particleOne.position, collisionResult.minimumTranslationVector);
this._particleTwo.position = Vector2.subtract(this._particleTwo.position, collisionResult.minimumTranslationVector);
}
}
}
}
public solve() {

View File

@@ -14,7 +14,7 @@ class VerletWorld {
private _composites: Composite[] = [];
private _fixedDeltaTimeSq: number;
private static _colliders: Collider[] = new Array(4);
public static colliders: Collider[] = new Array(4);
private _tempCircle: Circle = new Circle(1);
constructor(simulationBounds?: Rectangle){
@@ -52,9 +52,9 @@ class VerletWorld {
}
private handleCollisions(p: Particle, collidesWithLayers: number){
let collidedCount = Physics.overlapCircleAll(p.position, p.radius, VerletWorld._colliders, collidesWithLayers);
let collidedCount = Physics.overlapCircleAll(p.position, p.radius, VerletWorld.colliders, collidesWithLayers);
for (let i = 0; i < collidedCount; i ++){
let collider = VerletWorld._colliders[i];
let collider = VerletWorld.colliders[i];
if (collider.isTrigger)
continue;