@ue-too/dynamics 0.5.1 → 0.5.2
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/collision.js +330 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/collision.js.map +1 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/constraint.js +166 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/constraint.js.map +1 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/index.js +4 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/index.js.map +1 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/quadtree.js +124 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/quadtree.js.map +1 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/rigidbody.js +476 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/rigidbody.js.map +1 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/world.js +90 -0
- package/.rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/world.js.map +1 -0
- package/dist/collision.d.ts +36 -0
- package/dist/constraint.d.ts +35 -0
- package/dist/dynamics.tsbuildinfo +1 -0
- package/dist/index.d.ts +3 -0
- package/dist/package.json +22 -0
- package/dist/quadtree.d.ts +26 -0
- package/dist/rigidbody.d.ts +252 -0
- package/dist/world.d.ts +29 -0
- package/jest.config.js +18 -0
- package/package.json +10 -9
- package/project.json +33 -0
- package/rollup.config.js +20 -0
- package/src/collision.ts +359 -0
- package/src/constraint.ts +245 -0
- package/src/index.ts +3 -0
- package/src/quadtree.ts +145 -0
- package/src/rigidbody.ts +640 -0
- package/src/world.ts +116 -0
- package/test/rigidbody.test.ts +10 -0
- package/tsconfig.json +21 -0
- package/tsconfig.spec.json +12 -0
- /package/{collision.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/collision.d.ts} +0 -0
- /package/{constraint.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/constraint.d.ts} +0 -0
- /package/{dynamics.tsbuildinfo → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/dynamics.tsbuildinfo} +0 -0
- /package/{index.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/index.d.ts} +0 -0
- /package/{quadtree.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/quadtree.d.ts} +0 -0
- /package/{rigidbody.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/rigidbody.d.ts} +0 -0
- /package/{world.d.ts → .rollup.cache/home/runner/work/ue-too/ue-too/packages/dynamics/dist/world.d.ts} +0 -0
- /package/{index.js → dist/index.js} +0 -0
- /package/{index.js.map → dist/index.js.map} +0 -0
|
@@ -0,0 +1,330 @@
|
|
|
1
|
+
import { PointCal } from "@ue-too/math";
|
|
2
|
+
export function resolveCollision(bodyA, bodyB, normal) {
|
|
3
|
+
// console.log("resolve");
|
|
4
|
+
if (bodyA.isStatic() && bodyB.isStatic()) {
|
|
5
|
+
return;
|
|
6
|
+
}
|
|
7
|
+
let restitution = 0.4;
|
|
8
|
+
let inverseMassA = bodyA.isStatic() || bodyA.isMovingStatic() ? 0 : 1 / bodyA.mass;
|
|
9
|
+
let inverseMassB = bodyB.isStatic() || bodyB.isMovingStatic() ? 0 : 1 / bodyB.mass;
|
|
10
|
+
// console.log("inverse mass a", inverseMassA);
|
|
11
|
+
// console.log("inverse mass b", inverseMassB);
|
|
12
|
+
let relativeVelocity = PointCal.subVector(bodyA.linearVelocity, bodyB.linearVelocity);
|
|
13
|
+
// console.log("relative velocity: ", relativeVelocity);
|
|
14
|
+
// console.log("linear velocity of a", bodyA.getLinearVelocity());
|
|
15
|
+
// console.log("linear veolcity of b", bodyB.getLinearVelocity());
|
|
16
|
+
let J = -(1 + restitution) * PointCal.dotProduct(relativeVelocity, normal);
|
|
17
|
+
J /= inverseMassA + inverseMassB;
|
|
18
|
+
let deltaVelocityA = PointCal.multiplyVectorByScalar(normal, J * inverseMassA);
|
|
19
|
+
let deltaVelocityB = PointCal.multiplyVectorByScalar(normal, J * inverseMassB);
|
|
20
|
+
// console.log("delta velocity A:", deltaVelocityA);
|
|
21
|
+
// console.log("delta velocity B:", deltaVelocityB);
|
|
22
|
+
bodyA.linearVelocity = PointCal.addVector(bodyA.linearVelocity, deltaVelocityA);
|
|
23
|
+
bodyB.linearVelocity = PointCal.subVector(bodyB.linearVelocity, deltaVelocityB);
|
|
24
|
+
}
|
|
25
|
+
export function resolveCollisionWithRotation(bodyA, bodyB, contactManifold) {
|
|
26
|
+
// console.log("resolve");
|
|
27
|
+
if (bodyA.isStatic() && bodyB.isStatic()) {
|
|
28
|
+
return;
|
|
29
|
+
}
|
|
30
|
+
let restitution = 0.4;
|
|
31
|
+
let inverseMassA = bodyA.isStatic() || bodyA.isMovingStatic() ? 0 : 1 / bodyA.mass;
|
|
32
|
+
let inverseMassB = bodyB.isStatic() || bodyB.isMovingStatic() ? 0 : 1 / bodyB.mass;
|
|
33
|
+
let inverseMMOIA = bodyA.isStatic() || bodyA.isMovingStatic() ? 0 : 1 / bodyA.momentOfInertia;
|
|
34
|
+
let inverseMMOIB = bodyB.isStatic() || bodyB.isMovingStatic() ? 0 : 1 / bodyB.momentOfInertia;
|
|
35
|
+
const Js = [];
|
|
36
|
+
for (let index = 0; index < contactManifold.contactPoints.length; index++) {
|
|
37
|
+
const contactPoint = contactManifold.contactPoints[index];
|
|
38
|
+
const rA = PointCal.subVector(contactPoint, bodyA.center);
|
|
39
|
+
const rB = PointCal.subVector(contactPoint, bodyB.center);
|
|
40
|
+
const rAPerpendicular = { x: -rA.y, y: rA.x };
|
|
41
|
+
const rBPerpendicular = { x: -rB.y, y: rB.x };
|
|
42
|
+
const angularVelocityA = PointCal.multiplyVectorByScalar(rAPerpendicular, bodyA.angularVelocity);
|
|
43
|
+
const angularVelocityB = PointCal.multiplyVectorByScalar(rBPerpendicular, bodyB.angularVelocity);
|
|
44
|
+
// console.log("inverse mass a", inverseMassA);
|
|
45
|
+
// console.log("inverse mass b", inverseMassB);
|
|
46
|
+
let relativeVelocity = PointCal.subVector(PointCal.addVector(bodyA.linearVelocity, angularVelocityA), PointCal.addVector(bodyB.linearVelocity, angularVelocityB));
|
|
47
|
+
// console.log("relative velocity: ", relativeVelocity);
|
|
48
|
+
// console.log("linear velocity of a", bodyA.getLinearVelocity());
|
|
49
|
+
// console.log("linear veolcity of b", bodyB.getLinearVelocity());
|
|
50
|
+
let relativeVelocityNormal = PointCal.dotProduct(relativeVelocity, contactManifold.normal);
|
|
51
|
+
const rAPerpendicularNormal = PointCal.dotProduct(rAPerpendicular, contactManifold.normal);
|
|
52
|
+
const rBPerpendicularNormal = PointCal.dotProduct(rBPerpendicular, contactManifold.normal);
|
|
53
|
+
const denominator = inverseMassA + inverseMassB + rAPerpendicularNormal * rAPerpendicularNormal * inverseMMOIA + rBPerpendicularNormal * rBPerpendicularNormal * inverseMMOIB;
|
|
54
|
+
let J = -(1 + restitution) * relativeVelocityNormal;
|
|
55
|
+
J /= denominator;
|
|
56
|
+
J /= contactManifold.contactPoints.length;
|
|
57
|
+
Js.push(PointCal.multiplyVectorByScalar(contactManifold.normal, J));
|
|
58
|
+
}
|
|
59
|
+
Js.forEach((impulse, index) => {
|
|
60
|
+
let deltaVelocityA = PointCal.multiplyVectorByScalar(impulse, inverseMassA);
|
|
61
|
+
let deltaVelocityB = PointCal.multiplyVectorByScalar(impulse, inverseMassB);
|
|
62
|
+
bodyA.linearVelocity = PointCal.addVector(bodyA.linearVelocity, deltaVelocityA);
|
|
63
|
+
let resA = PointCal.crossProduct(PointCal.subVector(contactManifold.contactPoints[index], bodyA.center), impulse).z;
|
|
64
|
+
resA = resA == undefined ? 0 : resA;
|
|
65
|
+
let resB = PointCal.crossProduct(PointCal.subVector(contactManifold.contactPoints[index], bodyB.center), impulse).z;
|
|
66
|
+
resB = resB == undefined ? 0 : resB;
|
|
67
|
+
bodyA.angularVelocity += resA * inverseMMOIA;
|
|
68
|
+
bodyB.angularVelocity -= resB * inverseMMOIB;
|
|
69
|
+
bodyB.linearVelocity = PointCal.subVector(bodyB.linearVelocity, deltaVelocityB);
|
|
70
|
+
});
|
|
71
|
+
}
|
|
72
|
+
export function aabbIntersects(aabbA, aabbB) {
|
|
73
|
+
if ((aabbA.min.x <= aabbB.max.x && aabbB.min.x <= aabbA.max.x) && (aabbA.min.y <= aabbB.max.y && aabbB.min.y <= aabbA.max.y)) {
|
|
74
|
+
return true;
|
|
75
|
+
}
|
|
76
|
+
return false;
|
|
77
|
+
}
|
|
78
|
+
export function intersects(bodyA, bodyB) {
|
|
79
|
+
let axis = [];
|
|
80
|
+
let bodyAAxes = bodyA.getCollisionAxes(bodyB);
|
|
81
|
+
let bodyBAxes = bodyB.getCollisionAxes(bodyA);
|
|
82
|
+
axis.push(...bodyAAxes);
|
|
83
|
+
axis.push(...bodyBAxes);
|
|
84
|
+
let collision = true;
|
|
85
|
+
let minDepth = Number.MAX_VALUE;
|
|
86
|
+
let minAxis = axis[0];
|
|
87
|
+
axis.forEach(projAxis => {
|
|
88
|
+
let bodyAInterval = bodyA.getMinMaxProjection(projAxis);
|
|
89
|
+
let bodyBInterval = bodyB.getMinMaxProjection(projAxis);
|
|
90
|
+
if (bodyAInterval.min >= bodyBInterval.max || bodyBInterval.min >= bodyAInterval.max) {
|
|
91
|
+
collision = false;
|
|
92
|
+
}
|
|
93
|
+
else {
|
|
94
|
+
let depth = Math.abs(Math.min(bodyAInterval.max, bodyBInterval.max) - Math.max(bodyBInterval.min, bodyAInterval.min));
|
|
95
|
+
if (depth < minDepth) {
|
|
96
|
+
minDepth = depth;
|
|
97
|
+
minAxis = projAxis;
|
|
98
|
+
if (bodyAInterval.max < bodyBInterval.max) {
|
|
99
|
+
minAxis = PointCal.multiplyVectorByScalar(minAxis, -1);
|
|
100
|
+
}
|
|
101
|
+
}
|
|
102
|
+
}
|
|
103
|
+
});
|
|
104
|
+
if (collision) {
|
|
105
|
+
return { collision: collision, depth: minDepth, normal: minAxis };
|
|
106
|
+
}
|
|
107
|
+
else {
|
|
108
|
+
return { collision: false, depth: undefined, normal: undefined };
|
|
109
|
+
}
|
|
110
|
+
}
|
|
111
|
+
export function narrowPhaseWithRigidBody(bodies, combinationsToCheck, resolveCollisionFlag) {
|
|
112
|
+
if (!resolveCollisionFlag) {
|
|
113
|
+
return [];
|
|
114
|
+
}
|
|
115
|
+
const contactPoints = [];
|
|
116
|
+
combinationsToCheck.forEach(combination => {
|
|
117
|
+
let bodyA = combination.bodyA;
|
|
118
|
+
let bodyB = combination.bodyB;
|
|
119
|
+
if (bodyA == bodyB) {
|
|
120
|
+
// console.log("same body");
|
|
121
|
+
return;
|
|
122
|
+
}
|
|
123
|
+
let bodyAZ = bodyA.center.z == undefined ? 0 : bodyA.center.z;
|
|
124
|
+
let bodyBZ = bodyB.center.z == undefined ? 0 : bodyB.center.z;
|
|
125
|
+
if (Math.abs(bodyAZ - bodyBZ) > 0.5) {
|
|
126
|
+
// console.log("z-index difference is too large");
|
|
127
|
+
return;
|
|
128
|
+
}
|
|
129
|
+
let { collision, depth, normal: normalAxis } = intersects(bodyA, bodyB);
|
|
130
|
+
if (collision && normalAxis !== undefined && depth !== undefined) {
|
|
131
|
+
// the normal axis points in the direction that push bodyA away from bodyB
|
|
132
|
+
let moveDisplacement = PointCal.multiplyVectorByScalar(normalAxis, depth / 2);
|
|
133
|
+
let revMoveDisplacement = PointCal.multiplyVectorByScalar(normalAxis, -depth / 2);
|
|
134
|
+
if (!bodyA.isStatic()) {
|
|
135
|
+
bodyA.move(moveDisplacement);
|
|
136
|
+
}
|
|
137
|
+
if (!bodyB.isStatic()) {
|
|
138
|
+
bodyB.move(revMoveDisplacement);
|
|
139
|
+
}
|
|
140
|
+
if (bodyA.isStatic()) {
|
|
141
|
+
// bodyA.move(revMoveDisplacement);
|
|
142
|
+
bodyB.move(revMoveDisplacement);
|
|
143
|
+
}
|
|
144
|
+
if (bodyB.isStatic()) {
|
|
145
|
+
bodyA.move(moveDisplacement);
|
|
146
|
+
// bodyB.move(moveDisplacement);
|
|
147
|
+
}
|
|
148
|
+
// finding the collision contact point(s)
|
|
149
|
+
const bodyASigNormal = bodyA.getNormalOfSignificantFace(PointCal.multiplyVectorByScalar(normalAxis, -1));
|
|
150
|
+
const bodyBSigNormal = bodyB.getNormalOfSignificantFace(normalAxis);
|
|
151
|
+
const bodyASigVertices = bodyA.getSignificantVertices(PointCal.multiplyVectorByScalar(normalAxis, -1));
|
|
152
|
+
const bodyBSigVertices = bodyB.getSignificantVertices(normalAxis);
|
|
153
|
+
const bodyAParallelIndicator = Math.abs(PointCal.dotProduct(bodyASigNormal, PointCal.multiplyVectorByScalar(normalAxis, -1)));
|
|
154
|
+
const bodyBParallelIndicator = Math.abs(PointCal.dotProduct(bodyBSigNormal, normalAxis));
|
|
155
|
+
if (bodyBSigVertices.length == 1 || bodyASigVertices.length == 1) {
|
|
156
|
+
// one of the body is a circle
|
|
157
|
+
// console.log("involving a circle");
|
|
158
|
+
if (bodyBSigVertices.length == 1) {
|
|
159
|
+
// bodyB is a circle
|
|
160
|
+
// contact point is on the perimeter of the circle and the direction is the collision normal
|
|
161
|
+
contactPoints.push(bodyBSigVertices[0]);
|
|
162
|
+
}
|
|
163
|
+
else {
|
|
164
|
+
// bodyA is a circle
|
|
165
|
+
// contact point is on the perimeter of the circle and the direction is the collision normal
|
|
166
|
+
contactPoints.push(bodyASigVertices[0]);
|
|
167
|
+
}
|
|
168
|
+
}
|
|
169
|
+
else if (bodyAParallelIndicator > bodyBParallelIndicator) {
|
|
170
|
+
// bodyA has the normal that is the most parallel to the collision normal
|
|
171
|
+
const adjacentFaces = bodyA.getAdjacentFaces(PointCal.multiplyVectorByScalar(normalAxis, -1));
|
|
172
|
+
let faceToClip = [...bodyBSigVertices];
|
|
173
|
+
for (let index = 0; index < adjacentFaces.length - 1; index++) {
|
|
174
|
+
let startPoint = adjacentFaces[index].startPoint.coord;
|
|
175
|
+
let endPoint = adjacentFaces[index].endPoint.coord;
|
|
176
|
+
let direction = PointCal.subVector(endPoint, startPoint);
|
|
177
|
+
let sigStart = PointCal.subVector(faceToClip[0], startPoint);
|
|
178
|
+
let sigEnd = PointCal.subVector(faceToClip[1], startPoint);
|
|
179
|
+
let startInside = PointCal.angleFromA2B(direction, sigStart) >= 0;
|
|
180
|
+
let endInside = PointCal.angleFromA2B(direction, sigEnd) >= 0;
|
|
181
|
+
if ((startInside ? 1 : 0) ^ (endInside ? 1 : 0)) {
|
|
182
|
+
// one of the point is outside the face
|
|
183
|
+
let intersectionPoint = PointCal.getLineIntersection(startPoint, endPoint, faceToClip[0], faceToClip[1]);
|
|
184
|
+
if (intersectionPoint.intersects && intersectionPoint.intersection !== undefined) {
|
|
185
|
+
if (startInside) {
|
|
186
|
+
faceToClip[1] = intersectionPoint.intersection;
|
|
187
|
+
}
|
|
188
|
+
else {
|
|
189
|
+
faceToClip[0] = intersectionPoint.intersection;
|
|
190
|
+
}
|
|
191
|
+
}
|
|
192
|
+
}
|
|
193
|
+
}
|
|
194
|
+
const referenceFace = adjacentFaces[adjacentFaces.length - 1];
|
|
195
|
+
let startPoint = referenceFace.startPoint.coord;
|
|
196
|
+
let endPoint = referenceFace.endPoint.coord;
|
|
197
|
+
let direction = PointCal.subVector(endPoint, startPoint);
|
|
198
|
+
let sigStart = PointCal.subVector(faceToClip[0], startPoint);
|
|
199
|
+
let sigEnd = PointCal.subVector(faceToClip[1], startPoint);
|
|
200
|
+
let startInside = PointCal.angleFromA2B(direction, sigStart) >= 0;
|
|
201
|
+
let endInside = PointCal.angleFromA2B(direction, sigEnd) >= 0;
|
|
202
|
+
if (startInside) {
|
|
203
|
+
contactPoints.push(faceToClip[0]);
|
|
204
|
+
}
|
|
205
|
+
if (endInside) {
|
|
206
|
+
contactPoints.push(faceToClip[1]);
|
|
207
|
+
}
|
|
208
|
+
}
|
|
209
|
+
else {
|
|
210
|
+
// bodyB has the normal that is the most parallel to the collision normal
|
|
211
|
+
const adjacentFaces = bodyB.getAdjacentFaces(normalAxis);
|
|
212
|
+
let faceToClip = [...bodyASigVertices];
|
|
213
|
+
if (faceToClip.length == 0) {
|
|
214
|
+
console.log("warning");
|
|
215
|
+
}
|
|
216
|
+
let count = 0;
|
|
217
|
+
for (let index = 0; index < adjacentFaces.length - 1; index++) {
|
|
218
|
+
let startPoint = adjacentFaces[index].startPoint.coord;
|
|
219
|
+
let endPoint = adjacentFaces[index].endPoint.coord;
|
|
220
|
+
let direction = PointCal.subVector(endPoint, startPoint);
|
|
221
|
+
let sigStart = PointCal.subVector(faceToClip[0], startPoint);
|
|
222
|
+
let sigEnd = PointCal.subVector(faceToClip[1], startPoint);
|
|
223
|
+
let startInside = PointCal.angleFromA2B(direction, sigStart) >= 0;
|
|
224
|
+
let endInside = PointCal.angleFromA2B(direction, sigEnd) >= 0;
|
|
225
|
+
if ((startInside ? 1 : 0) ^ (endInside ? 1 : 0)) {
|
|
226
|
+
count += 1;
|
|
227
|
+
// one of the point is outside the face
|
|
228
|
+
let intersectionPoint = PointCal.getLineIntersection(startPoint, endPoint, faceToClip[0], faceToClip[1]);
|
|
229
|
+
if (intersectionPoint.intersects && intersectionPoint.intersection !== undefined) {
|
|
230
|
+
if (startInside) {
|
|
231
|
+
faceToClip[1] = intersectionPoint.intersection;
|
|
232
|
+
}
|
|
233
|
+
else {
|
|
234
|
+
faceToClip[0] = intersectionPoint.intersection;
|
|
235
|
+
}
|
|
236
|
+
}
|
|
237
|
+
}
|
|
238
|
+
}
|
|
239
|
+
const referenceFace = adjacentFaces[adjacentFaces.length - 1];
|
|
240
|
+
let startPoint = referenceFace.startPoint.coord;
|
|
241
|
+
let endPoint = referenceFace.endPoint.coord;
|
|
242
|
+
let direction = PointCal.subVector(endPoint, startPoint);
|
|
243
|
+
let sigStart = PointCal.subVector(faceToClip[0], startPoint);
|
|
244
|
+
let sigEnd = PointCal.subVector(faceToClip[1], startPoint);
|
|
245
|
+
let startInside = PointCal.angleFromA2B(direction, sigStart) >= 0;
|
|
246
|
+
let endInside = PointCal.angleFromA2B(direction, sigEnd) >= 0;
|
|
247
|
+
if (startInside) {
|
|
248
|
+
contactPoints.push(faceToClip[0]);
|
|
249
|
+
}
|
|
250
|
+
if (endInside) {
|
|
251
|
+
contactPoints.push(faceToClip[1]);
|
|
252
|
+
}
|
|
253
|
+
}
|
|
254
|
+
if (resolveCollisionFlag) {
|
|
255
|
+
resolveCollisionWithRotation(bodyA, bodyB, { normal: normalAxis, contactPoints: contactPoints });
|
|
256
|
+
// resolveCollision(bodyA, bodyB, normalAxis);
|
|
257
|
+
}
|
|
258
|
+
}
|
|
259
|
+
});
|
|
260
|
+
return contactPoints;
|
|
261
|
+
}
|
|
262
|
+
export function narrowPhase(bodies, combinationsToCheck, resolveCollisionFlag) {
|
|
263
|
+
if (!resolveCollisionFlag) {
|
|
264
|
+
return;
|
|
265
|
+
}
|
|
266
|
+
combinationsToCheck.forEach(combination => {
|
|
267
|
+
let bodyA = bodies[combination.bodyAIndex];
|
|
268
|
+
let bodyB = bodies[combination.bodyBIndex];
|
|
269
|
+
let { collision, depth, normal: normalAxis } = intersects(bodyA, bodyB);
|
|
270
|
+
if (collision && normalAxis !== undefined && depth !== undefined) {
|
|
271
|
+
// console.log("collision");
|
|
272
|
+
let moveDisplacement = PointCal.multiplyVectorByScalar(normalAxis, depth / 2);
|
|
273
|
+
let revMoveDisplacement = PointCal.multiplyVectorByScalar(normalAxis, -depth / 2);
|
|
274
|
+
if (!bodyA.isStatic()) {
|
|
275
|
+
bodyA.move(moveDisplacement);
|
|
276
|
+
}
|
|
277
|
+
if (!bodyB.isStatic()) {
|
|
278
|
+
bodyB.move(revMoveDisplacement);
|
|
279
|
+
}
|
|
280
|
+
if (bodyA.isStatic()) {
|
|
281
|
+
// bodyA.move(revMoveDisplacement);
|
|
282
|
+
bodyB.move(revMoveDisplacement);
|
|
283
|
+
}
|
|
284
|
+
if (bodyB.isStatic()) {
|
|
285
|
+
bodyA.move(moveDisplacement);
|
|
286
|
+
// bodyB.move(moveDisplacement);
|
|
287
|
+
}
|
|
288
|
+
if (resolveCollisionFlag) {
|
|
289
|
+
resolveCollision(bodyA, bodyB, normalAxis);
|
|
290
|
+
}
|
|
291
|
+
}
|
|
292
|
+
});
|
|
293
|
+
}
|
|
294
|
+
export function broadPhaseWithRigidBodyReturned(quadTree, bodies) {
|
|
295
|
+
let possibleCombi = [];
|
|
296
|
+
for (let index = 0; index <= bodies.length - 1; index++) {
|
|
297
|
+
let objsToCheck = quadTree.retrieve(bodies[index]);
|
|
298
|
+
for (let jindex = 0; jindex <= objsToCheck.length - 1; jindex++) {
|
|
299
|
+
let bodyA = bodies[index];
|
|
300
|
+
let bodyB = objsToCheck[jindex];
|
|
301
|
+
if (bodyA.isStatic() && bodyB.isStatic()) {
|
|
302
|
+
continue;
|
|
303
|
+
}
|
|
304
|
+
if (!aabbIntersects(bodyA.AABB, bodyB.AABB)) {
|
|
305
|
+
continue;
|
|
306
|
+
}
|
|
307
|
+
possibleCombi.push({ bodyA: bodyA, bodyB: bodyB });
|
|
308
|
+
}
|
|
309
|
+
}
|
|
310
|
+
return possibleCombi;
|
|
311
|
+
}
|
|
312
|
+
export function broadPhase(quadTree, bodies) {
|
|
313
|
+
let possibleCombi = [];
|
|
314
|
+
for (let index = 0; index <= bodies.length - 1; index++) {
|
|
315
|
+
let objsToCheck = quadTree.retrieve(bodies[index]);
|
|
316
|
+
for (let jindex = 0; jindex <= objsToCheck.length - 1; jindex++) {
|
|
317
|
+
let bodyA = bodies[index];
|
|
318
|
+
let bodyB = objsToCheck[jindex];
|
|
319
|
+
if (bodyA.isStatic() && bodyB.isStatic()) {
|
|
320
|
+
continue;
|
|
321
|
+
}
|
|
322
|
+
if (!aabbIntersects(bodyA.AABB, bodyB.AABB)) {
|
|
323
|
+
continue;
|
|
324
|
+
}
|
|
325
|
+
possibleCombi.push({ bodyAIndex: index, bodyBIndex: jindex });
|
|
326
|
+
}
|
|
327
|
+
}
|
|
328
|
+
return possibleCombi;
|
|
329
|
+
}
|
|
330
|
+
//# sourceMappingURL=collision.js.map
|
|
@@ -0,0 +1 @@
|
|
|
1
|
+
{"version":3,"file":"collision.js","sourceRoot":"","sources":["../src/collision.ts"],"names":[],"mappings":"AACA,OAAO,EAAE,QAAQ,EAAS,MAAM,cAAc,CAAC;AAG/C,MAAM,UAAU,gBAAgB,CAAC,KAAgB,EAAE,KAAgB,EAAE,MAAa;IAC9E,0BAA0B;IAC1B,IAAI,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;QACvC,OAAO;IACX,CAAC;IACD,IAAI,WAAW,GAAG,GAAG,CAAC;IACtB,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IACnF,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IACnF,+CAA+C;IAC/C,+CAA+C;IAE/C,IAAI,gBAAgB,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,KAAK,CAAC,cAAc,CAAC,CAAC;IACtF,wDAAwD;IACxD,kEAAkE;IAClE,kEAAkE;IAClE,IAAI,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,WAAW,CAAC,GAAG,QAAQ,CAAC,UAAU,CAAC,gBAAgB,EAAE,MAAM,CAAC,CAAC;IAC3E,CAAC,IAAI,YAAY,GAAG,YAAY,CAAC;IAEjC,IAAI,cAAc,GAAG,QAAQ,CAAC,sBAAsB,CAAC,MAAM,EAAE,CAAC,GAAG,YAAY,CAAC,CAAC;IAC/E,IAAI,cAAc,GAAG,QAAQ,CAAC,sBAAsB,CAAC,MAAM,EAAE,CAAC,GAAG,YAAY,CAAC,CAAC;IAC/E,oDAAoD;IACpD,oDAAoD;IAEpD,KAAK,CAAC,cAAc,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,cAAc,CAAC,CAAC;IAChF,KAAK,CAAC,cAAc,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,cAAc,CAAC,CAAC;AACpF,CAAC;AAED,MAAM,UAAU,4BAA4B,CAAC,KAAgB,EAAE,KAAgB,EAAE,eAAwD;IACrI,0BAA0B;IAC1B,IAAI,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;QACvC,OAAO;IACX,CAAC;IAED,IAAI,WAAW,GAAG,GAAG,CAAC;IACtB,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IACnF,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IAEnF,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;IAC9F,IAAI,YAAY,GAAG,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,cAAc,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;IAE9F,MAAM,EAAE,GAAY,EAAE,CAAC;IACvB,KAAI,IAAI,KAAK,GAAG,CAAC,EAAE,KAAK,GAAG,eAAe,CAAC,aAAa,CAAC,MAAM,EAAE,KAAK,EAAE,EAAC,CAAC;QACtE,MAAM,YAAY,GAAG,eAAe,CAAC,aAAa,CAAC,KAAK,CAAC,CAAC;QAC1D,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;QAC1D,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;QAC1D,MAAM,eAAe,GAAG,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,EAAE,CAAC,EAAE,EAAE,CAAC,CAAC,EAAC,CAAC;QAC5C,MAAM,eAAe,GAAG,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,EAAE,CAAC,EAAE,EAAE,CAAC,CAAC,EAAC,CAAC;QAE5C,MAAM,gBAAgB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,eAAe,EAAE,KAAK,CAAC,eAAe,CAAC,CAAC;QACjG,MAAM,gBAAgB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,eAAe,EAAE,KAAK,CAAC,eAAe,CAAC,CAAC;QAEjG,+CAA+C;QAC/C,+CAA+C;QAE/C,IAAI,gBAAgB,GAAG,QAAQ,CAAC,SAAS,CAAC,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,gBAAgB,CAAC,EAAE,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,gBAAgB,CAAC,CAAC,CAAC;QAClK,wDAAwD;QACxD,kEAAkE;QAClE,kEAAkE;QAClE,IAAI,sBAAsB,GAAG,QAAQ,CAAC,UAAU,CAAC,gBAAgB,EAAE,eAAe,CAAC,MAAM,CAAC,CAAC;QAC3F,MAAM,qBAAqB,GAAG,QAAQ,CAAC,UAAU,CAAC,eAAe,EAAE,eAAe,CAAC,MAAM,CAAC,CAAC;QAC3F,MAAM,qBAAqB,GAAG,QAAQ,CAAC,UAAU,CAAC,eAAe,EAAE,eAAe,CAAC,MAAM,CAAC,CAAC;QAE3F,MAAM,WAAW,GAAG,YAAY,GAAG,YAAY,GAAG,qBAAqB,GAAG,qBAAqB,GAAG,YAAY,GAAG,qBAAqB,GAAG,qBAAqB,GAAG,YAAY,CAAC;QAC9K,IAAI,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,WAAW,CAAC,GAAG,sBAAsB,CAAC;QACpD,CAAC,IAAI,WAAW,CAAC;QAEjB,CAAC,IAAI,eAAe,CAAC,aAAa,CAAC,MAAM,CAAC;QAE1C,EAAE,CAAC,IAAI,CAAC,QAAQ,CAAC,sBAAsB,CAAC,eAAe,CAAC,MAAM,EAAE,CAAC,CAAC,CAAC,CAAC;IACxE,CAAC;IAED,EAAE,CAAC,OAAO,CAAC,CAAC,OAAO,EAAE,KAAK,EAAE,EAAE;QAC1B,IAAI,cAAc,GAAG,QAAQ,CAAC,sBAAsB,CAAC,OAAO,EAAE,YAAY,CAAC,CAAC;QAC5E,IAAI,cAAc,GAAG,QAAQ,CAAC,sBAAsB,CAAC,OAAO,EAAE,YAAY,CAAC,CAAC;QAE5E,KAAK,CAAC,cAAc,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,cAAc,CAAC,CAAC;QAChF,IAAI,IAAI,GAAG,QAAQ,CAAC,YAAY,CAAC,QAAQ,CAAC,SAAS,CAAC,eAAe,CAAC,aAAa,CAAC,KAAK,CAAC,EAAE,KAAK,CAAC,MAAM,CAAC,EAAE,OAAO,CAAC,CAAC,CAAC,CAAC;QACpH,IAAI,GAAG,IAAI,IAAI,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,IAAI,CAAC;QACpC,IAAI,IAAI,GAAG,QAAQ,CAAC,YAAY,CAAC,QAAQ,CAAC,SAAS,CAAC,eAAe,CAAC,aAAa,CAAC,KAAK,CAAC,EAAE,KAAK,CAAC,MAAM,CAAC,EAAE,OAAO,CAAC,CAAC,CAAC,CAAC;QACpH,IAAI,GAAG,IAAI,IAAI,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,IAAI,CAAC;QACpC,KAAK,CAAC,eAAe,IAAI,IAAI,GAAG,YAAY,CAAC;QAC7C,KAAK,CAAC,eAAe,IAAI,IAAI,GAAG,YAAY,CAAC;QAC7C,KAAK,CAAC,cAAc,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,cAAc,CAAC,CAAC;IACpF,CAAC,CAAC,CAAC;AACP,CAAC;AAED,MAAM,UAAU,cAAc,CAAC,KAA+B,EAAE,KAA+B;IAC3F,IAAI,CAAC,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,CAAC,IAAI,CAAC,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,IAAI,KAAK,CAAC,GAAG,CAAC,CAAC,CAAC,EAAE,CAAC;QAC3H,OAAO,IAAI,CAAC;IAChB,CAAC;IACD,OAAO,KAAK,CAAC;AACjB,CAAC;AAED,MAAM,UAAU,UAAU,CAAC,KAAgB,EAAE,KAAgB;IACzD,IAAI,IAAI,GAAY,EAAE,CAAC;IACvB,IAAI,SAAS,GAAG,KAAK,CAAC,gBAAgB,CAAC,KAAK,CAAC,CAAC;IAC9C,IAAI,SAAS,GAAG,KAAK,CAAC,gBAAgB,CAAC,KAAK,CAAC,CAAC;IAE9C,IAAI,CAAC,IAAI,CAAC,GAAG,SAAS,CAAC,CAAC;IACxB,IAAI,CAAC,IAAI,CAAC,GAAG,SAAS,CAAC,CAAC;IAExB,IAAI,SAAS,GAAG,IAAI,CAAC;IACrB,IAAI,QAAQ,GAAG,MAAM,CAAC,SAAS,CAAC;IAChC,IAAI,OAAO,GAAG,IAAI,CAAC,CAAC,CAAC,CAAC;IAEtB,IAAI,CAAC,OAAO,CAAC,QAAQ,CAAC,EAAE;QACpB,IAAI,aAAa,GAAG,KAAK,CAAC,mBAAmB,CAAC,QAAQ,CAAC,CAAC;QACxD,IAAI,aAAa,GAAG,KAAK,CAAC,mBAAmB,CAAC,QAAQ,CAAC,CAAC;QAExD,IAAI,aAAa,CAAC,GAAG,IAAI,aAAa,CAAC,GAAG,IAAI,aAAa,CAAC,GAAG,IAAI,aAAa,CAAC,GAAG,EAAE,CAAC;YACnF,SAAS,GAAG,KAAK,CAAC;QACtB,CAAC;aAAK,CAAC;YACH,IAAI,KAAK,GAAG,IAAI,CAAC,GAAG,CAAC,IAAI,CAAC,GAAG,CAAC,aAAa,CAAC,GAAG,EAAE,aAAa,CAAC,GAAG,CAAC,GAAG,IAAI,CAAC,GAAG,CAAC,aAAa,CAAC,GAAG,EAAE,aAAa,CAAC,GAAG,CAAC,CAAC,CAAC;YACtH,IAAI,KAAK,GAAG,QAAQ,EAAE,CAAC;gBACnB,QAAQ,GAAG,KAAK,CAAC;gBACjB,OAAO,GAAG,QAAQ,CAAC;gBACnB,IAAI,aAAa,CAAC,GAAG,GAAG,aAAa,CAAC,GAAG,EAAE,CAAC;oBACxC,OAAO,GAAG,QAAQ,CAAC,sBAAsB,CAAC,OAAO,EAAE,CAAC,CAAC,CAAC,CAAC;gBAC3D,CAAC;YACL,CAAC;QACL,CAAC;IACL,CAAC,CAAC,CAAC;IAEH,IAAI,SAAS,EAAC,CAAC;QACX,OAAO,EAAC,SAAS,EAAE,SAAS,EAAE,KAAK,EAAE,QAAQ,EAAE,MAAM,EAAE,OAAO,EAAC,CAAC;IACpE,CAAC;SAAK,CAAC;QACH,OAAO,EAAC,SAAS,EAAE,KAAK,EAAE,KAAK,EAAE,SAAS,EAAE,MAAM,EAAE,SAAS,EAAC,CAAC;IACnE,CAAC;AACL,CAAC;AAED,MAAM,UAAU,wBAAwB,CAAC,MAAmB,EAAE,mBAA2D,EAAE,oBAA6B;IACpJ,IAAI,CAAC,oBAAoB,EAAE,CAAC;QACxB,OAAO,EAAE,CAAC;IACd,CAAC;IACD,MAAM,aAAa,GAAY,EAAE,CAAC;IAClC,mBAAmB,CAAC,OAAO,CAAC,WAAW,CAAC,EAAE;QACtC,IAAI,KAAK,GAAG,WAAW,CAAC,KAAK,CAAC;QAC9B,IAAI,KAAK,GAAG,WAAW,CAAC,KAAK,CAAC;QAC9B,IAAI,KAAK,IAAI,KAAK,EAAE,CAAC;YACjB,4BAA4B;YAC5B,OAAO;QACX,CAAC;QACD,IAAI,MAAM,GAAG,KAAK,CAAC,MAAM,CAAC,CAAC,IAAI,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,KAAK,CAAC,MAAM,CAAC,CAAC,CAAC;QAC9D,IAAI,MAAM,GAAG,KAAK,CAAC,MAAM,CAAC,CAAC,IAAI,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,KAAK,CAAC,MAAM,CAAC,CAAC,CAAC;QAC9D,IAAG,IAAI,CAAC,GAAG,CAAC,MAAM,GAAG,MAAM,CAAC,GAAG,GAAG,EAAC,CAAC;YAChC,kDAAkD;YAClD,OAAO;QACX,CAAC;QACD,IAAI,EAAC,SAAS,EAAE,KAAK,EAAE,MAAM,EAAE,UAAU,EAAC,GAAG,UAAU,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;QACtE,IAAI,SAAS,IAAI,UAAU,KAAK,SAAS,IAAI,KAAK,KAAK,SAAS,EAAE,CAAC;YAC/D,0EAA0E;YAE1E,IAAI,gBAAgB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,KAAK,GAAG,CAAC,CAAC,CAAC;YAC9E,IAAI,mBAAmB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,KAAK,GAAG,CAAC,CAAC,CAAC;YAElF,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACpB,KAAK,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC;YACjC,CAAC;YACD,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACpB,KAAK,CAAC,IAAI,CAAC,mBAAmB,CAAC,CAAC;YACpC,CAAC;YACD,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACnB,mCAAmC;gBACnC,KAAK,CAAC,IAAI,CAAC,mBAAmB,CAAC,CAAC;YACpC,CAAC;YACD,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACnB,KAAK,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC;gBAC7B,gCAAgC;YACpC,CAAC;YAED,yCAAyC;YACzC,MAAM,cAAc,GAAG,KAAK,CAAC,0BAA0B,CAAC,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC;YACzG,MAAM,cAAc,GAAG,KAAK,CAAC,0BAA0B,CAAC,UAAU,CAAC,CAAC;YACpE,MAAM,gBAAgB,GAAG,KAAK,CAAC,sBAAsB,CAAC,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC;YACvG,MAAM,gBAAgB,GAAG,KAAK,CAAC,sBAAsB,CAAC,UAAU,CAAC,CAAC;YAClE,MAAM,sBAAsB,GAAG,IAAI,CAAC,GAAG,CAAC,QAAQ,CAAC,UAAU,CAAC,cAAc,EAAE,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC;YAC9H,MAAM,sBAAsB,GAAG,IAAI,CAAC,GAAG,CAAC,QAAQ,CAAC,UAAU,CAAC,cAAc,EAAE,UAAU,CAAC,CAAC,CAAC;YAEzF,IAAI,gBAAgB,CAAC,MAAM,IAAI,CAAC,IAAI,gBAAgB,CAAC,MAAM,IAAI,CAAC,EAAC,CAAC;gBAC9D,8BAA8B;gBAC9B,qCAAqC;gBACrC,IAAI,gBAAgB,CAAC,MAAM,IAAI,CAAC,EAAC,CAAC;oBAC9B,oBAAoB;oBACpB,4FAA4F;oBAC5F,aAAa,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC,CAAC,CAAC,CAAC;gBAC5C,CAAC;qBAAM,CAAC;oBACJ,oBAAoB;oBACpB,4FAA4F;oBAC5F,aAAa,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC,CAAC,CAAC,CAAC;gBAC5C,CAAC;YACL,CAAC;iBACI,IAAI,sBAAsB,GAAG,sBAAsB,EAAE,CAAC;gBACvD,yEAAyE;gBACzE,MAAM,aAAa,GAAG,KAAK,CAAC,gBAAgB,CAAC,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC;gBAC9F,IAAI,UAAU,GAAG,CAAC,GAAG,gBAAgB,CAAC,CAAC;gBACvC,KAAI,IAAI,KAAK,GAAG,CAAC,EAAE,KAAK,GAAG,aAAa,CAAC,MAAM,GAAG,CAAC,EAAE,KAAK,EAAE,EAAC,CAAC;oBAC1D,IAAI,UAAU,GAAG,aAAa,CAAC,KAAK,CAAC,CAAC,UAAU,CAAC,KAAK,CAAC;oBACvD,IAAI,QAAQ,GAAG,aAAa,CAAC,KAAK,CAAC,CAAC,QAAQ,CAAC,KAAK,CAAC;oBACnD,IAAI,SAAS,GAAG,QAAQ,CAAC,SAAS,CAAC,QAAQ,EAAE,UAAU,CAAC,CAAC;oBACzD,IAAI,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;oBAC7D,IAAI,MAAM,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;oBAC3D,IAAI,WAAW,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,QAAQ,CAAC,IAAI,CAAC,CAAC;oBAClE,IAAI,SAAS,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,MAAM,CAAC,IAAI,CAAC,CAAC;oBAC9D,IAAI,CAAC,WAAW,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,CAAC,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,EAAC,CAAC;wBAC7C,uCAAuC;wBACvC,IAAI,iBAAiB,GAAG,QAAQ,CAAC,mBAAmB,CAAC,UAAU,EAAE,QAAQ,EAAE,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;wBACzG,IAAI,iBAAiB,CAAC,UAAU,IAAI,iBAAiB,CAAC,YAAY,KAAK,SAAS,EAAC,CAAC;4BAC9E,IAAG,WAAW,EAAC,CAAC;gCACZ,UAAU,CAAC,CAAC,CAAC,GAAG,iBAAiB,CAAC,YAAY,CAAC;4BACnD,CAAC;iCAAM,CAAC;gCACJ,UAAU,CAAC,CAAC,CAAC,GAAG,iBAAiB,CAAC,YAAY,CAAC;4BACnD,CAAC;wBACL,CAAC;oBACL,CAAC;gBACL,CAAC;gBACD,MAAM,aAAa,GAAG,aAAa,CAAC,aAAa,CAAC,MAAM,GAAG,CAAC,CAAC,CAAC;gBAC9D,IAAI,UAAU,GAAG,aAAa,CAAC,UAAU,CAAC,KAAK,CAAC;gBAChD,IAAI,QAAQ,GAAG,aAAa,CAAC,QAAQ,CAAC,KAAK,CAAC;gBAC5C,IAAI,SAAS,GAAG,QAAQ,CAAC,SAAS,CAAC,QAAQ,EAAE,UAAU,CAAC,CAAC;gBACzD,IAAI,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;gBAC7D,IAAI,MAAM,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;gBAC3D,IAAI,WAAW,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,QAAQ,CAAC,IAAI,CAAC,CAAC;gBAClE,IAAI,SAAS,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,MAAM,CAAC,IAAI,CAAC,CAAC;gBAC9D,IAAI,WAAW,EAAC,CAAC;oBACb,aAAa,CAAC,IAAI,CAAC,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;gBACtC,CAAC;gBACD,IAAI,SAAS,EAAC,CAAC;oBACX,aAAa,CAAC,IAAI,CAAC,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;gBACtC,CAAC;YACL,CAAC;iBAAM,CAAC;gBACJ,yEAAyE;gBACzE,MAAM,aAAa,GAAG,KAAK,CAAC,gBAAgB,CAAC,UAAU,CAAC,CAAC;gBACzD,IAAI,UAAU,GAAG,CAAC,GAAG,gBAAgB,CAAC,CAAC;gBACvC,IAAG,UAAU,CAAC,MAAM,IAAI,CAAC,EAAC,CAAC;oBACvB,OAAO,CAAC,GAAG,CAAC,SAAS,CAAC,CAAC;gBAC3B,CAAC;gBACD,IAAI,KAAK,GAAG,CAAC,CAAC;gBACd,KAAI,IAAI,KAAK,GAAG,CAAC,EAAE,KAAK,GAAG,aAAa,CAAC,MAAM,GAAG,CAAC,EAAE,KAAK,EAAE,EAAC,CAAC;oBAC1D,IAAI,UAAU,GAAG,aAAa,CAAC,KAAK,CAAC,CAAC,UAAU,CAAC,KAAK,CAAC;oBACvD,IAAI,QAAQ,GAAG,aAAa,CAAC,KAAK,CAAC,CAAC,QAAQ,CAAC,KAAK,CAAC;oBACnD,IAAI,SAAS,GAAG,QAAQ,CAAC,SAAS,CAAC,QAAQ,EAAE,UAAU,CAAC,CAAC;oBACzD,IAAI,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;oBAC7D,IAAI,MAAM,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;oBAC3D,IAAI,WAAW,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,QAAQ,CAAC,IAAI,CAAC,CAAC;oBAClE,IAAI,SAAS,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,MAAM,CAAC,IAAI,CAAC,CAAC;oBAC9D,IAAI,CAAC,WAAW,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,CAAC,SAAS,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,EAAC,CAAC;wBAC7C,KAAK,IAAI,CAAC,CAAC;wBACX,uCAAuC;wBACvC,IAAI,iBAAiB,GAAG,QAAQ,CAAC,mBAAmB,CAAC,UAAU,EAAE,QAAQ,EAAE,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;wBACzG,IAAI,iBAAiB,CAAC,UAAU,IAAI,iBAAiB,CAAC,YAAY,KAAK,SAAS,EAAC,CAAC;4BAC9E,IAAG,WAAW,EAAC,CAAC;gCACZ,UAAU,CAAC,CAAC,CAAC,GAAG,iBAAiB,CAAC,YAAY,CAAC;4BACnD,CAAC;iCAAM,CAAC;gCACJ,UAAU,CAAC,CAAC,CAAC,GAAG,iBAAiB,CAAC,YAAY,CAAC;4BACnD,CAAC;wBACL,CAAC;oBACL,CAAC;gBACL,CAAC;gBACD,MAAM,aAAa,GAAG,aAAa,CAAC,aAAa,CAAC,MAAM,GAAG,CAAC,CAAC,CAAC;gBAC9D,IAAI,UAAU,GAAG,aAAa,CAAC,UAAU,CAAC,KAAK,CAAC;gBAChD,IAAI,QAAQ,GAAG,aAAa,CAAC,QAAQ,CAAC,KAAK,CAAC;gBAC5C,IAAI,SAAS,GAAG,QAAQ,CAAC,SAAS,CAAC,QAAQ,EAAE,UAAU,CAAC,CAAC;gBACzD,IAAI,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;gBAC7D,IAAI,MAAM,GAAG,QAAQ,CAAC,SAAS,CAAC,UAAU,CAAC,CAAC,CAAC,EAAE,UAAU,CAAC,CAAC;gBAC3D,IAAI,WAAW,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,QAAQ,CAAC,IAAI,CAAC,CAAC;gBAClE,IAAI,SAAS,GAAG,QAAQ,CAAC,YAAY,CAAC,SAAS,EAAE,MAAM,CAAC,IAAI,CAAC,CAAC;gBAC9D,IAAI,WAAW,EAAC,CAAC;oBACb,aAAa,CAAC,IAAI,CAAC,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;gBACtC,CAAC;gBACD,IAAI,SAAS,EAAC,CAAC;oBACX,aAAa,CAAC,IAAI,CAAC,UAAU,CAAC,CAAC,CAAC,CAAC,CAAC;gBACtC,CAAC;YACL,CAAC;YACD,IAAI,oBAAoB,EAAE,CAAC;gBACvB,4BAA4B,CAAC,KAAK,EAAE,KAAK,EAAE,EAAC,MAAM,EAAE,UAAU,EAAE,aAAa,EAAE,aAAa,EAAC,CAAC,CAAC;gBAC/F,8CAA8C;YAClD,CAAC;QACL,CAAC;IACL,CAAC,CAAC,CAAC;IACH,OAAO,aAAa,CAAC;AACzB,CAAC;AAED,MAAM,UAAU,WAAW,CAAC,MAAuB,EAAE,mBAA+D,EAAE,oBAA6B;IAC/I,IAAI,CAAC,oBAAoB,EAAE,CAAC;QACxB,OAAO;IACX,CAAC;IACD,mBAAmB,CAAC,OAAO,CAAC,WAAW,CAAC,EAAE;QACtC,IAAI,KAAK,GAAG,MAAM,CAAC,WAAW,CAAC,UAAU,CAAC,CAAC;QAC3C,IAAI,KAAK,GAAG,MAAM,CAAC,WAAW,CAAC,UAAU,CAAC,CAAC;QAC3C,IAAI,EAAC,SAAS,EAAE,KAAK,EAAE,MAAM,EAAE,UAAU,EAAC,GAAG,UAAU,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;QACtE,IAAI,SAAS,IAAI,UAAU,KAAK,SAAS,IAAI,KAAK,KAAK,SAAS,EAAE,CAAC;YAC/D,4BAA4B;YAC5B,IAAI,gBAAgB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,KAAK,GAAG,CAAC,CAAC,CAAC;YAC9E,IAAI,mBAAmB,GAAG,QAAQ,CAAC,sBAAsB,CAAC,UAAU,EAAE,CAAC,KAAK,GAAG,CAAC,CAAC,CAAC;YAElF,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACpB,KAAK,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC;YACjC,CAAC;YACD,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACpB,KAAK,CAAC,IAAI,CAAC,mBAAmB,CAAC,CAAC;YACpC,CAAC;YACD,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACnB,mCAAmC;gBACnC,KAAK,CAAC,IAAI,CAAC,mBAAmB,CAAC,CAAC;YACpC,CAAC;YACD,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;gBACnB,KAAK,CAAC,IAAI,CAAC,gBAAgB,CAAC,CAAC;gBAC7B,gCAAgC;YACpC,CAAC;YAED,IAAI,oBAAoB,EAAE,CAAC;gBACvB,gBAAgB,CAAC,KAAK,EAAE,KAAK,EAAE,UAAU,CAAC,CAAC;YAC/C,CAAC;QAEL,CAAC;IACL,CAAC,CAAC,CAAA;AACN,CAAC;AAED,MAAM,UAAU,+BAA+B,CAAC,QAAkB,EAAE,MAAmB;IACnF,IAAI,aAAa,GAA2C,EAAE,CAAC;IAC/D,KAAI,IAAI,KAAK,GAAG,CAAC,EAAE,KAAK,IAAI,MAAM,CAAC,MAAM,GAAG,CAAC,EAAE,KAAK,EAAE,EAAC,CAAC;QACpD,IAAI,WAAW,GAAG,QAAQ,CAAC,QAAQ,CAAC,MAAM,CAAC,KAAK,CAAC,CAAC,CAAC;QACnD,KAAI,IAAI,MAAM,GAAG,CAAC,EAAE,MAAM,IAAI,WAAW,CAAC,MAAM,GAAG,CAAC,EAAE,MAAM,EAAE,EAAC,CAAC;YAC5D,IAAI,KAAK,GAAG,MAAM,CAAC,KAAK,CAAC,CAAC;YAC1B,IAAI,KAAK,GAAG,WAAW,CAAC,MAAM,CAAC,CAAC;YAChC,IAAI,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAC,CAAC;gBACtC,SAAS;YACb,CAAC;YACD,IAAG,CAAC,cAAc,CAAC,KAAK,CAAC,IAAI,EAAE,KAAK,CAAC,IAAI,CAAC,EAAC,CAAC;gBACxC,SAAS;YACb,CAAC;YACD,aAAa,CAAC,IAAI,CAAC,EAAC,KAAK,EAAE,KAAK,EAAE,KAAK,EAAE,KAAK,EAAC,CAAC,CAAC;QACrD,CAAC;IACL,CAAC;IACD,OAAO,aAAa,CAAA;AACxB,CAAC;AAED,MAAM,UAAU,UAAU,CAAC,QAAkB,EAAE,MAAuB;IAClE,IAAI,aAAa,GAA+C,EAAE,CAAC;IACnE,KAAI,IAAI,KAAK,GAAG,CAAC,EAAE,KAAK,IAAI,MAAM,CAAC,MAAM,GAAG,CAAC,EAAE,KAAK,EAAE,EAAC,CAAC;QACpD,IAAI,WAAW,GAAG,QAAQ,CAAC,QAAQ,CAAC,MAAM,CAAC,KAAK,CAAC,CAAC,CAAC;QACnD,KAAI,IAAI,MAAM,GAAG,CAAC,EAAE,MAAM,IAAI,WAAW,CAAC,MAAM,GAAG,CAAC,EAAE,MAAM,EAAE,EAAC,CAAC;YAC5D,IAAI,KAAK,GAAG,MAAM,CAAC,KAAK,CAAC,CAAC;YAC1B,IAAI,KAAK,GAAG,WAAW,CAAC,MAAM,CAAC,CAAC;YAChC,IAAI,KAAK,CAAC,QAAQ,EAAE,IAAI,KAAK,CAAC,QAAQ,EAAE,EAAC,CAAC;gBACtC,SAAS;YACb,CAAC;YACD,IAAG,CAAC,cAAc,CAAC,KAAK,CAAC,IAAI,EAAE,KAAK,CAAC,IAAI,CAAC,EAAC,CAAC;gBACxC,SAAS;YACb,CAAC;YACD,aAAa,CAAC,IAAI,CAAC,EAAC,UAAU,EAAE,KAAK,EAAE,UAAU,EAAE,MAAM,EAAC,CAAC,CAAC;QAChE,CAAC;IACL,CAAC;IACD,OAAO,aAAa,CAAA;AACxB,CAAC"}
|
|
@@ -0,0 +1,166 @@
|
|
|
1
|
+
import { PointCal } from "@ue-too/math";
|
|
2
|
+
export class FixedPinJoint {
|
|
3
|
+
constructor(bodyA, anchorA, worldAnchorA) {
|
|
4
|
+
this.bodyA = bodyA;
|
|
5
|
+
this.anchorA = anchorA;
|
|
6
|
+
this.worldAnchorA = worldAnchorA;
|
|
7
|
+
}
|
|
8
|
+
enforce(dt) {
|
|
9
|
+
this.solveWorldPinJointConstraint(dt);
|
|
10
|
+
}
|
|
11
|
+
solveWorldPinJointConstraint(dt) {
|
|
12
|
+
const body = this.bodyA;
|
|
13
|
+
const localAnchor = this.anchorA;
|
|
14
|
+
const worldAnchor = this.worldAnchorA;
|
|
15
|
+
// Transform local anchor point to world space
|
|
16
|
+
const worldAnchorOnBody = PointCal.addVector(body.center, PointCal.rotatePoint(localAnchor, body.orientationAngle));
|
|
17
|
+
// Calculate the difference between the anchor points
|
|
18
|
+
const diff = PointCal.subVector(worldAnchorOnBody, worldAnchor);
|
|
19
|
+
// Calculate the relative velocity of the anchor point
|
|
20
|
+
const r = PointCal.subVector(worldAnchorOnBody, body.center);
|
|
21
|
+
const velocity = PointCal.addVector(body.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: body.angularVelocity }, r));
|
|
22
|
+
// Calculate the mass matrix
|
|
23
|
+
const invMass = body.isStatic() ? 0 : 1 / body.mass;
|
|
24
|
+
const invI = body.isStatic() ? 0 : 1 / body.momentOfInertia;
|
|
25
|
+
const K = {
|
|
26
|
+
x: invMass + invI * r.y * r.y,
|
|
27
|
+
y: invMass + invI * r.x * r.x,
|
|
28
|
+
xy: -invI * r.x * r.y
|
|
29
|
+
};
|
|
30
|
+
// Calculate the impulse
|
|
31
|
+
const baumgarte = 1; // Baumgarte stabilization factor
|
|
32
|
+
const impulse = {
|
|
33
|
+
x: -K.x * diff.x - K.xy * diff.y - baumgarte * diff.x / dt - velocity.x,
|
|
34
|
+
y: -K.xy * diff.x - K.y * diff.y - baumgarte * diff.y / dt - velocity.y
|
|
35
|
+
};
|
|
36
|
+
// Apply the impulse
|
|
37
|
+
if (!body.isStatic()) {
|
|
38
|
+
body.linearVelocity.x += invMass * impulse.x;
|
|
39
|
+
body.linearVelocity.y += invMass * impulse.y;
|
|
40
|
+
body.angularVelocity += invI * (r.x * impulse.y - r.y * impulse.x);
|
|
41
|
+
}
|
|
42
|
+
}
|
|
43
|
+
}
|
|
44
|
+
export class PinJoint {
|
|
45
|
+
constructor(bodyA, bodyB, anchorA, anchorB) {
|
|
46
|
+
this.bodyA = bodyA;
|
|
47
|
+
this.bodyB = bodyB;
|
|
48
|
+
this.anchorA = anchorA;
|
|
49
|
+
this.anchorB = anchorB;
|
|
50
|
+
}
|
|
51
|
+
enforce(dt) {
|
|
52
|
+
this.solvePinJointConstraint(dt);
|
|
53
|
+
}
|
|
54
|
+
solvePinJointConstraint(dt) {
|
|
55
|
+
const bodyA = this.bodyA;
|
|
56
|
+
const bodyB = this.bodyB;
|
|
57
|
+
const anchorA = this.anchorA;
|
|
58
|
+
const anchorB = this.anchorB;
|
|
59
|
+
// Transform local anchor points to world space
|
|
60
|
+
const worldAnchorA = PointCal.addVector(bodyA.center, PointCal.rotatePoint(anchorA, bodyA.orientationAngle));
|
|
61
|
+
const worldAnchorB = PointCal.addVector(bodyB.center, PointCal.rotatePoint(anchorB, bodyB.orientationAngle));
|
|
62
|
+
// Calculate the difference between the two anchor points in world space
|
|
63
|
+
const diff = PointCal.subVector(worldAnchorB, worldAnchorA);
|
|
64
|
+
// Calculate the relative velocity of the anchor points
|
|
65
|
+
const rA = PointCal.subVector(worldAnchorA, bodyA.center);
|
|
66
|
+
const rB = PointCal.subVector(worldAnchorB, bodyB.center);
|
|
67
|
+
const relativeVelocity = PointCal.subVector(PointCal.addVector(bodyB.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: bodyB.angularVelocity }, rB)), PointCal.addVector(bodyA.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: bodyA.angularVelocity }, rA)));
|
|
68
|
+
// Calculate the mass matrix
|
|
69
|
+
const invMassA = bodyA.isStatic() ? 0 : 1 / bodyA.mass;
|
|
70
|
+
const invMassB = bodyB.isStatic() ? 0 : 1 / bodyB.mass;
|
|
71
|
+
const invIA = bodyA.isStatic() ? 0 : 1 / bodyA.momentOfInertia;
|
|
72
|
+
const invIB = bodyB.isStatic() ? 0 : 1 / bodyB.momentOfInertia;
|
|
73
|
+
const K = {
|
|
74
|
+
x: invMassA + invMassB + invIA * rA.y * rA.y + invIB * rB.y * rB.y,
|
|
75
|
+
y: invMassA + invMassB + invIA * rA.x * rA.x + invIB * rB.x * rB.x,
|
|
76
|
+
xy: -invIA * rA.x * rA.y - invIB * rB.x * rB.y
|
|
77
|
+
};
|
|
78
|
+
// Calculate the impulse
|
|
79
|
+
const baumgarte = 1; // Baumgarte stabilization factor
|
|
80
|
+
const impulse = {
|
|
81
|
+
x: -K.x * diff.x - K.xy * diff.y - baumgarte * diff.x / dt - relativeVelocity.x,
|
|
82
|
+
y: -K.xy * diff.x - K.y * diff.y - baumgarte * diff.y / dt - relativeVelocity.y
|
|
83
|
+
};
|
|
84
|
+
// Apply the impulse
|
|
85
|
+
if (!bodyA.isStatic()) {
|
|
86
|
+
bodyA.linearVelocity.x -= invMassA * impulse.x;
|
|
87
|
+
bodyA.linearVelocity.y -= invMassA * impulse.y;
|
|
88
|
+
bodyA.angularVelocity -= invIA * (rA.x * impulse.y - rA.y * impulse.x);
|
|
89
|
+
}
|
|
90
|
+
if (!bodyB.isStatic()) {
|
|
91
|
+
bodyB.linearVelocity.x += invMassB * impulse.x;
|
|
92
|
+
bodyB.linearVelocity.y += invMassB * impulse.y;
|
|
93
|
+
bodyB.angularVelocity += invIB * (rB.x * impulse.y - rB.y * impulse.x);
|
|
94
|
+
}
|
|
95
|
+
}
|
|
96
|
+
}
|
|
97
|
+
export function solvePinJointConstraint(constraint, dt) {
|
|
98
|
+
const { bodyA, bodyB, anchorA, anchorB } = constraint;
|
|
99
|
+
// Transform local anchor points to world space
|
|
100
|
+
const worldAnchorA = PointCal.addVector(bodyA.center, PointCal.rotatePoint(anchorA, bodyA.orientationAngle));
|
|
101
|
+
const worldAnchorB = PointCal.addVector(bodyB.center, PointCal.rotatePoint(anchorB, bodyB.orientationAngle));
|
|
102
|
+
// Calculate the difference between the two anchor points in world space
|
|
103
|
+
const diff = PointCal.subVector(worldAnchorB, worldAnchorA);
|
|
104
|
+
// Calculate the relative velocity of the anchor points
|
|
105
|
+
const rA = PointCal.subVector(worldAnchorA, bodyA.center);
|
|
106
|
+
const rB = PointCal.subVector(worldAnchorB, bodyB.center);
|
|
107
|
+
const relativeVelocity = PointCal.subVector(PointCal.addVector(bodyB.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: bodyB.angularVelocity }, rB)), PointCal.addVector(bodyA.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: bodyA.angularVelocity }, rA)));
|
|
108
|
+
// Calculate the mass matrix
|
|
109
|
+
const invMassA = bodyA.isStatic() ? 0 : 1 / bodyA.mass;
|
|
110
|
+
const invMassB = bodyB.isStatic() ? 0 : 1 / bodyB.mass;
|
|
111
|
+
const invIA = bodyA.isStatic() ? 0 : 1 / bodyA.momentOfInertia;
|
|
112
|
+
const invIB = bodyB.isStatic() ? 0 : 1 / bodyB.momentOfInertia;
|
|
113
|
+
const K = {
|
|
114
|
+
x: invMassA + invMassB + invIA * rA.y * rA.y + invIB * rB.y * rB.y,
|
|
115
|
+
y: invMassA + invMassB + invIA * rA.x * rA.x + invIB * rB.x * rB.x,
|
|
116
|
+
xy: -invIA * rA.x * rA.y - invIB * rB.x * rB.y
|
|
117
|
+
};
|
|
118
|
+
// Calculate the impulse
|
|
119
|
+
const baumgarte = 0.5; // Baumgarte stabilization factor
|
|
120
|
+
const impulse = {
|
|
121
|
+
x: -K.x * diff.x - K.xy * diff.y - baumgarte * diff.x / dt - relativeVelocity.x,
|
|
122
|
+
y: -K.xy * diff.x - K.y * diff.y - baumgarte * diff.y / dt - relativeVelocity.y
|
|
123
|
+
};
|
|
124
|
+
// Apply the impulse
|
|
125
|
+
if (!bodyA.isStatic()) {
|
|
126
|
+
bodyA.linearVelocity.x -= invMassA * impulse.x;
|
|
127
|
+
bodyA.linearVelocity.y -= invMassA * impulse.y;
|
|
128
|
+
bodyA.angularVelocity -= invIA * (rA.x * impulse.y - rA.y * impulse.x);
|
|
129
|
+
}
|
|
130
|
+
if (!bodyB.isStatic()) {
|
|
131
|
+
bodyB.linearVelocity.x += invMassB * impulse.x;
|
|
132
|
+
bodyB.linearVelocity.y += invMassB * impulse.y;
|
|
133
|
+
bodyB.angularVelocity += invIB * (rB.x * impulse.y - rB.y * impulse.x);
|
|
134
|
+
}
|
|
135
|
+
}
|
|
136
|
+
export function solveWorldPinJointConstraint(constraint, dt) {
|
|
137
|
+
const { body, localAnchor, worldAnchor } = constraint;
|
|
138
|
+
// Transform local anchor point to world space
|
|
139
|
+
const worldAnchorOnBody = PointCal.addVector(body.center, PointCal.rotatePoint(localAnchor, body.orientationAngle));
|
|
140
|
+
// Calculate the difference between the anchor points
|
|
141
|
+
const diff = PointCal.subVector(worldAnchorOnBody, worldAnchor);
|
|
142
|
+
// Calculate the relative velocity of the anchor point
|
|
143
|
+
const r = PointCal.subVector(worldAnchorOnBody, body.center);
|
|
144
|
+
const velocity = PointCal.addVector(body.linearVelocity, PointCal.crossProduct({ x: 0, y: 0, z: body.angularVelocity }, r));
|
|
145
|
+
// Calculate the mass matrix
|
|
146
|
+
const invMass = body.isStatic() ? 0 : 1 / body.mass;
|
|
147
|
+
const invI = body.isStatic() ? 0 : 1 / body.momentOfInertia;
|
|
148
|
+
const K = {
|
|
149
|
+
x: invMass + invI * r.y * r.y,
|
|
150
|
+
y: invMass + invI * r.x * r.x,
|
|
151
|
+
xy: -invI * r.x * r.y
|
|
152
|
+
};
|
|
153
|
+
// Calculate the impulse
|
|
154
|
+
const baumgarte = 0.2; // Baumgarte stabilization factor
|
|
155
|
+
const impulse = {
|
|
156
|
+
x: -K.x * diff.x - K.xy * diff.y - baumgarte * diff.x / dt - velocity.x,
|
|
157
|
+
y: -K.xy * diff.x - K.y * diff.y - baumgarte * diff.y / dt - velocity.y
|
|
158
|
+
};
|
|
159
|
+
// Apply the impulse
|
|
160
|
+
if (!body.isStatic()) {
|
|
161
|
+
body.linearVelocity.x += invMass * impulse.x;
|
|
162
|
+
body.linearVelocity.y += invMass * impulse.y;
|
|
163
|
+
body.angularVelocity += invI * (r.x * impulse.y - r.y * impulse.x);
|
|
164
|
+
}
|
|
165
|
+
}
|
|
166
|
+
//# sourceMappingURL=constraint.js.map
|
|
@@ -0,0 +1 @@
|
|
|
1
|
+
{"version":3,"file":"constraint.js","sourceRoot":"","sources":["../src/constraint.ts"],"names":[],"mappings":"AAAA,OAAO,EAAS,QAAQ,EAAE,MAAM,cAAc,CAAC;AAO/C,MAAM,OAAO,aAAa;IAMtB,YAAY,KAAgB,EAAE,OAAc,EAAE,YAAmB;QAC7D,IAAI,CAAC,KAAK,GAAG,KAAK,CAAC;QACnB,IAAI,CAAC,OAAO,GAAG,OAAO,CAAC;QACvB,IAAI,CAAC,YAAY,GAAG,YAAY,CAAC;IACrC,CAAC;IAED,OAAO,CAAC,EAAU;QACd,IAAI,CAAC,4BAA4B,CAAC,EAAE,CAAC,CAAC;IAC1C,CAAC;IAED,4BAA4B,CAAC,EAAU;QACnC,MAAM,IAAI,GAAG,IAAI,CAAC,KAAK,CAAC;QACxB,MAAM,WAAW,GAAG,IAAI,CAAC,OAAO,CAAC;QACjC,MAAM,WAAW,GAAG,IAAI,CAAC,YAAY,CAAC;QAEtC,8CAA8C;QAC9C,MAAM,iBAAiB,GAAG,QAAQ,CAAC,SAAS,CAAC,IAAI,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,WAAW,EAAE,IAAI,CAAC,gBAAgB,CAAC,CAAC,CAAC;QAEpH,qDAAqD;QACrD,MAAM,IAAI,GAAG,QAAQ,CAAC,SAAS,CAAC,iBAAiB,EAAE,WAAW,CAAC,CAAC;QAEhE,sDAAsD;QACtD,MAAM,CAAC,GAAG,QAAQ,CAAC,SAAS,CAAC,iBAAiB,EAAE,IAAI,CAAC,MAAM,CAAC,CAAC;QAC7D,MAAM,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAC/B,IAAI,CAAC,cAAc,EACnB,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,IAAI,CAAC,eAAe,EAAC,EAAE,CAAC,CAAC,CAClE,CAAC;QAEF,4BAA4B;QAC5B,MAAM,OAAO,GAAG,IAAI,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,IAAI,CAAC;QACpD,MAAM,IAAI,GAAG,IAAI,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,eAAe,CAAC;QAE5D,MAAM,CAAC,GAAG;YACN,CAAC,EAAE,OAAO,GAAG,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;YAC7B,CAAC,EAAE,OAAO,GAAG,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;YAC7B,EAAE,EAAE,CAAC,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;SACxB,CAAC;QAEF,wBAAwB;QACxB,MAAM,SAAS,GAAG,CAAC,CAAC,CAAC,iCAAiC;QACtD,MAAM,OAAO,GAAG;YACZ,CAAC,EAAE,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC;YACvE,CAAC,EAAE,CAAC,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC;SAC1E,CAAC;QAEF,oBAAoB;QACpB,IAAI,CAAC,IAAI,CAAC,QAAQ,EAAE,EAAE,CAAC;YACnB,IAAI,CAAC,cAAc,CAAC,CAAC,IAAI,OAAO,GAAG,OAAO,CAAC,CAAC,CAAC;YAC7C,IAAI,CAAC,cAAc,CAAC,CAAC,IAAI,OAAO,GAAG,OAAO,CAAC,CAAC,CAAC;YAC7C,IAAI,CAAC,eAAe,IAAI,IAAI,GAAG,CAAC,CAAC,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;QACvE,CAAC;IACL,CAAC;CACJ;AAED,MAAM,OAAO,QAAQ;IAOjB,YAAY,KAAgB,EAAE,KAAgB,EAAE,OAAc,EAAE,OAAc;QAC1E,IAAI,CAAC,KAAK,GAAG,KAAK,CAAC;QACnB,IAAI,CAAC,KAAK,GAAG,KAAK,CAAC;QACnB,IAAI,CAAC,OAAO,GAAG,OAAO,CAAC;QACvB,IAAI,CAAC,OAAO,GAAG,OAAO,CAAC;IAC3B,CAAC;IAED,OAAO,CAAC,EAAU;QACd,IAAI,CAAC,uBAAuB,CAAC,EAAE,CAAC,CAAC;IACrC,CAAC;IAED,uBAAuB,CAAC,EAAU;QAC9B,MAAM,KAAK,GAAG,IAAI,CAAC,KAAK,CAAC;QACzB,MAAM,KAAK,GAAG,IAAI,CAAC,KAAK,CAAC;QACzB,MAAM,OAAO,GAAG,IAAI,CAAC,OAAO,CAAC;QAC7B,MAAM,OAAO,GAAG,IAAI,CAAC,OAAO,CAAC;QAE7B,+CAA+C;QAC/C,MAAM,YAAY,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,OAAO,EAAE,KAAK,CAAC,gBAAgB,CAAC,CAAC,CAAC;QAC7G,MAAM,YAAY,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,OAAO,EAAE,KAAK,CAAC,gBAAgB,CAAC,CAAC,CAAC;QAE7G,wEAAwE;QACxE,MAAM,IAAI,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,YAAY,CAAC,CAAC;QAE5D,uDAAuD;QACvD,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;QAC1D,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;QAC1D,MAAM,gBAAgB,GAAG,QAAQ,CAAC,SAAS,CACvC,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,KAAK,CAAC,eAAe,EAAC,EAAE,EAAE,CAAC,CAAC,EAC3G,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,KAAK,CAAC,eAAe,EAAC,EAAE,EAAE,CAAC,CAAC,CAC9G,CAAC;QAEF,4BAA4B;QAC5B,MAAM,QAAQ,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;QACvD,MAAM,QAAQ,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;QACvD,MAAM,KAAK,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;QAC/D,MAAM,KAAK,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;QAE/D,MAAM,CAAC,GAAG;YACN,CAAC,EAAE,QAAQ,GAAG,QAAQ,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;YAClE,CAAC,EAAE,QAAQ,GAAG,QAAQ,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;YAClE,EAAE,EAAE,CAAC,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;SACjD,CAAC;QAEF,wBAAwB;QACxB,MAAM,SAAS,GAAG,CAAC,CAAC,CAAC,iCAAiC;QACtD,MAAM,OAAO,GAAG;YACZ,CAAC,EAAE,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,gBAAgB,CAAC,CAAC;YAC/E,CAAC,EAAE,CAAC,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,gBAAgB,CAAC,CAAC;SAClF,CAAC;QAEF,oBAAoB;QACpB,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;YACpB,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;YAC/C,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;YAC/C,KAAK,CAAC,eAAe,IAAI,KAAK,GAAG,CAAC,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;QAC3E,CAAC;QAED,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;YACpB,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;YAC/C,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;YAC/C,KAAK,CAAC,eAAe,IAAI,KAAK,GAAG,CAAC,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;QAC3E,CAAC;IACL,CAAC;CAEJ;AASD,MAAM,UAAU,uBAAuB,CAAC,UAA8B,EAAE,EAAU;IAC9E,MAAM,EAAE,KAAK,EAAE,KAAK,EAAE,OAAO,EAAE,OAAO,EAAE,GAAG,UAAU,CAAC;IAEtD,+CAA+C;IAC/C,MAAM,YAAY,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,OAAO,EAAE,KAAK,CAAC,gBAAgB,CAAC,CAAC,CAAC;IAC7G,MAAM,YAAY,GAAG,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,OAAO,EAAE,KAAK,CAAC,gBAAgB,CAAC,CAAC,CAAC;IAE7G,wEAAwE;IACxE,MAAM,IAAI,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,YAAY,CAAC,CAAC;IAE5D,uDAAuD;IACvD,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;IAC1D,MAAM,EAAE,GAAG,QAAQ,CAAC,SAAS,CAAC,YAAY,EAAE,KAAK,CAAC,MAAM,CAAC,CAAC;IAC1D,MAAM,gBAAgB,GAAG,QAAQ,CAAC,SAAS,CACvC,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,KAAK,CAAC,eAAe,EAAC,EAAE,EAAE,CAAC,CAAC,EAC3G,QAAQ,CAAC,SAAS,CAAC,KAAK,CAAC,cAAc,EAAE,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,KAAK,CAAC,eAAe,EAAC,EAAE,EAAE,CAAC,CAAC,CAC9G,CAAC;IAEF,4BAA4B;IAC5B,MAAM,QAAQ,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IACvD,MAAM,QAAQ,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,IAAI,CAAC;IACvD,MAAM,KAAK,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;IAC/D,MAAM,KAAK,GAAG,KAAK,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,eAAe,CAAC;IAE/D,MAAM,CAAC,GAAG;QACN,CAAC,EAAE,QAAQ,GAAG,QAAQ,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;QAClE,CAAC,EAAE,QAAQ,GAAG,QAAQ,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;QAClE,EAAE,EAAE,CAAC,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,KAAK,GAAG,EAAE,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC;KACjD,CAAC;IAEF,wBAAwB;IACxB,MAAM,SAAS,GAAG,GAAG,CAAC,CAAC,iCAAiC;IACxD,MAAM,OAAO,GAAG;QACZ,CAAC,EAAE,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,gBAAgB,CAAC,CAAC;QAC/E,CAAC,EAAE,CAAC,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,gBAAgB,CAAC,CAAC;KAClF,CAAC;IAEF,oBAAoB;IACpB,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;QACpB,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;QAC/C,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;QAC/C,KAAK,CAAC,eAAe,IAAI,KAAK,GAAG,CAAC,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;IAC3E,CAAC;IAED,IAAI,CAAC,KAAK,CAAC,QAAQ,EAAE,EAAE,CAAC;QACpB,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;QAC/C,KAAK,CAAC,cAAc,CAAC,CAAC,IAAI,QAAQ,GAAG,OAAO,CAAC,CAAC,CAAC;QAC/C,KAAK,CAAC,eAAe,IAAI,KAAK,GAAG,CAAC,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,EAAE,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;IAC3E,CAAC;AACL,CAAC;AAQD,MAAM,UAAU,4BAA4B,CAAC,UAAmC,EAAE,EAAU;IACxF,MAAM,EAAE,IAAI,EAAE,WAAW,EAAE,WAAW,EAAE,GAAG,UAAU,CAAC;IAEtD,8CAA8C;IAC9C,MAAM,iBAAiB,GAAG,QAAQ,CAAC,SAAS,CAAC,IAAI,CAAC,MAAM,EAAE,QAAQ,CAAC,WAAW,CAAC,WAAW,EAAE,IAAI,CAAC,gBAAgB,CAAC,CAAC,CAAC;IAEpH,qDAAqD;IACrD,MAAM,IAAI,GAAG,QAAQ,CAAC,SAAS,CAAC,iBAAiB,EAAE,WAAW,CAAC,CAAC;IAEhE,sDAAsD;IACtD,MAAM,CAAC,GAAG,QAAQ,CAAC,SAAS,CAAC,iBAAiB,EAAE,IAAI,CAAC,MAAM,CAAC,CAAC;IAC7D,MAAM,QAAQ,GAAG,QAAQ,CAAC,SAAS,CAC/B,IAAI,CAAC,cAAc,EACnB,QAAQ,CAAC,YAAY,CAAC,EAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,IAAI,CAAC,eAAe,EAAC,EAAE,CAAC,CAAC,CAClE,CAAC;IAEF,4BAA4B;IAC5B,MAAM,OAAO,GAAG,IAAI,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,IAAI,CAAC;IACpD,MAAM,IAAI,GAAG,IAAI,CAAC,QAAQ,EAAE,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,eAAe,CAAC;IAE5D,MAAM,CAAC,GAAG;QACN,CAAC,EAAE,OAAO,GAAG,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;QAC7B,CAAC,EAAE,OAAO,GAAG,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;QAC7B,EAAE,EAAE,CAAC,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC;KACxB,CAAC;IAEF,wBAAwB;IACxB,MAAM,SAAS,GAAG,GAAG,CAAC,CAAC,iCAAiC;IACxD,MAAM,OAAO,GAAG;QACZ,CAAC,EAAE,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC;QACvE,CAAC,EAAE,CAAC,CAAC,CAAC,EAAE,GAAG,IAAI,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC,CAAC,GAAG,SAAS,GAAG,IAAI,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC;KAC1E,CAAC;IAEF,oBAAoB;IACpB,IAAI,CAAC,IAAI,CAAC,QAAQ,EAAE,EAAE,CAAC;QACnB,IAAI,CAAC,cAAc,CAAC,CAAC,IAAI,OAAO,GAAG,OAAO,CAAC,CAAC,CAAC;QAC7C,IAAI,CAAC,cAAc,CAAC,CAAC,IAAI,OAAO,GAAG,OAAO,CAAC,CAAC,CAAC;QAC7C,IAAI,CAAC,eAAe,IAAI,IAAI,GAAG,CAAC,CAAC,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,GAAG,CAAC,CAAC,CAAC,GAAG,OAAO,CAAC,CAAC,CAAC,CAAC;IACvE,CAAC;AACL,CAAC"}
|
|
@@ -0,0 +1 @@
|
|
|
1
|
+
{"version":3,"file":"index.js","sourceRoot":"","sources":["../src/index.ts"],"names":[],"mappings":"AAAA,cAAc,aAAa,CAAC;AAC5B,cAAc,YAAY,CAAC;AAC3B,cAAc,aAAa,CAAC"}
|