91 lines
2.2 KiB
TypeScript
91 lines
2.2 KiB
TypeScript
/*
|
|
* Copyright (c) Erin Catto
|
|
* Licensed under the MIT license
|
|
*/
|
|
|
|
import {
|
|
World,
|
|
Transform,
|
|
Box,
|
|
TimeOfImpact,
|
|
Sweep,
|
|
TOIInput,
|
|
TOIOutput,
|
|
stats,
|
|
Testbed,
|
|
Vec2Value,
|
|
} from "planck";
|
|
|
|
const world = new World();
|
|
|
|
const testbed = Testbed.mount();
|
|
testbed.width = 80;
|
|
testbed.height = 60;
|
|
testbed.x = 0;
|
|
testbed.y = 0;
|
|
testbed.start(world);
|
|
|
|
const shapeA = new Box(25.0, 5.0);
|
|
const sweepA = new Sweep();
|
|
sweepA.c0.set(0, 0);
|
|
sweepA.a0 = 0.1;
|
|
sweepA.c.set(sweepA.c0);
|
|
sweepA.a = sweepA.a0;
|
|
sweepA.localCenter.setZero();
|
|
|
|
const shapeB = new Box(2.5, 2.5);
|
|
const sweepB = new Sweep();
|
|
sweepB.c0.set(20, 20);
|
|
sweepB.a0 = 0.1; // - 162.0 * Math.PI;
|
|
sweepB.c.set(-20, -20);
|
|
sweepB.a = 3.1; // - 162.0 * Math.PI;
|
|
sweepB.localCenter.setZero();
|
|
|
|
// sweepB.a0 -= 300.0 * Math.PI;
|
|
// sweepB.a -= 300.0 * Math.PI;
|
|
|
|
const input = new TOIInput();
|
|
input.proxyA.set(shapeA, 0);
|
|
input.sweepA.set(sweepA);
|
|
input.proxyB.set(shapeB, 0);
|
|
input.sweepB.set(sweepB);
|
|
input.tMax = 1.0;
|
|
|
|
const output = new TOIOutput();
|
|
|
|
TimeOfImpact(output, input);
|
|
|
|
testbed.step = function () {
|
|
// "max toi iters = %d, max root iters = %d", b2_toiMaxIters, b2_toiMaxRootIters
|
|
|
|
testbed.status("toi", output.t);
|
|
testbed.status(stats);
|
|
|
|
let vertices: Vec2Value[] = [];
|
|
|
|
const transformB = new Transform();
|
|
|
|
for (let t = 0.1; t < 1.0; t += 0.1) {
|
|
sweepB.getTransform(transformB, t);
|
|
vertices = shapeB.m_vertices.map((v) => Transform.mul(transformB, v));
|
|
testbed.drawPolygon(vertices, testbed.color(0.2, 0.2, 0.2));
|
|
}
|
|
|
|
const transformA = new Transform();
|
|
sweepA.getTransform(transformA, 0.0);
|
|
vertices = shapeA.m_vertices.map((v) => Transform.mul(transformA, v));
|
|
testbed.drawPolygon(vertices, testbed.color(0.7, 0.7, 0.7));
|
|
|
|
sweepB.getTransform(transformB, 0.0);
|
|
vertices = shapeB.m_vertices.map((v) => Transform.mul(transformB, v));
|
|
testbed.drawPolygon(vertices, testbed.color(1, 1, 1));
|
|
|
|
sweepB.getTransform(transformB, output.t);
|
|
vertices = shapeB.m_vertices.map((v) => Transform.mul(transformB, v));
|
|
testbed.drawPolygon(vertices, testbed.color(1, 0, 0));
|
|
|
|
sweepB.getTransform(transformB, 1.0);
|
|
vertices = shapeB.m_vertices.map((v) => Transform.mul(transformB, v));
|
|
testbed.drawPolygon(vertices, testbed.color(1, 1, 1));
|
|
};
|