Package net.phys2d.math

Examples of net.phys2d.math.Vector2f.scale()

220
221
222
223
224
225
226
227
228
229
230
    accum1.scale(-body1.getInvMass());
    body1.adjustVelocity(accum1);
    body1.adjustAngularVelocity(-(body1.getInvI() * MathUtil.cross(r1, accumulatedImpulse)));

    Vector2f accum2 = new Vector2f(accumulatedImpulse);
    accum2.scale(body2.getInvMass());
    body2.adjustVelocity(accum2);
    body2.adjustAngularVelocity(body2.getInvI() * MathUtil.cross(r2, accumulatedImpulse));
  }
 
  /**
 
View Full Code Here
233
234
235
236
237
238
239
240
241
242
243
  public void applyImpulse() {
    Vector2f dv = new Vector2f(body2.getVelocity());
    dv.add(MathUtil.cross(body2.getAngularVelocity(),r2));
    dv.sub(body1.getVelocity());
    dv.sub(MathUtil.cross(body1.getAngularVelocity(),r1));
      dv.scale(-1);
      dv.add(bias);
     
      if (dv.lengthSquared() == 0) {
        return;
      }
View Full Code Here
243
244
245
246
247
248
249
250
251
252
253
      }
     
    Vector2f impulse = MathUtil.mul(M, dv);

    Vector2f delta1 = new Vector2f(impulse);
    delta1.scale(-body1.getInvMass());
    body1.adjustVelocity(delta1);
    body1.adjustAngularVelocity(-body1.getInvI() * MathUtil.cross(r1,impulse));

    Vector2f delta2 = new Vector2f(impulse);
    delta2.scale(body2.getInvMass());
View Full Code Here
248
249
250
251
252
253
254
255
256
257
258
    delta1.scale(-body1.getInvMass());
    body1.adjustVelocity(delta1);
    body1.adjustAngularVelocity(-body1.getInvI() * MathUtil.cross(r1,impulse));

    Vector2f delta2 = new Vector2f(impulse);
    delta2.scale(body2.getInvMass());
    body2.adjustVelocity(delta2);
    body2.adjustAngularVelocity(body2.getInvI() * MathUtil.cross(r2,impulse));

    accumulatedImpulse.add(impulse);
  }
 
View Full Code Here
166
167
168
169
170
171
172
173
174
175
176
      p = newImpulse - oldImpulse;
    }
    accumulateImpulse = newImpulse;

    Vector2f impulse = new Vector2f(n);
    impulse.scale(p);
    if (!body1.isStatic()) {
      Vector2f accum1 = new Vector2f(impulse);
      accum1.scale(body1.getInvMass());
      body1.adjustVelocity(accum1);
      body1.adjustAngularVelocity((body1.getInvI() * MathUtil.cross(R,
 
View Full Code Here
169
170
171
172
173
174
175
176
177
178
179
    Vector2f impulse = new Vector2f(n);
    impulse.scale(p);
    if (!body1.isStatic()) {
      Vector2f accum1 = new Vector2f(impulse);
      accum1.scale(body1.getInvMass());
      body1.adjustVelocity(accum1);
      body1.adjustAngularVelocity((body1.getInvI() * MathUtil.cross(R,
          impulse)));
    }
    if (!body2.isStatic()) {
View Full Code Here
176
177
178
179
180
181
182
183
184
185
186
      body1.adjustAngularVelocity((body1.getInvI() * MathUtil.cross(R,
          impulse)));
    }
    if (!body2.isStatic()) {
      Vector2f accum2 = new Vector2f(impulse);
      accum2.scale(-body2.getInvMass());
      body2.adjustVelocity(accum2);
      body2.adjustAngularVelocity(-(body2.getInvI() * MathUtil.cross(r2,
          impulse)));
    }
  }
 
View Full Code Here
240
241
242
243
244
245
246
247
248
249
250
     * relativeVelocity.add(MathUtil.mul(tr1, dp));
     */
    // relativeVelocity.add(MathUtil.cross(dp,body1.getAngularVelocity()));
    n = new Vector2f(-ndp.y, ndp.x);
    Vector2f v1 = new Vector2f(n);
    v1.scale(-body2.getInvMass() - body1.getInvMass());

    Vector2f v2 = MathUtil.cross(MathUtil.cross(r2, n), r2);
    v2.scale(-body2.getInvI());

    Vector2f v3 = MathUtil.cross(MathUtil.cross(R, n), r1);
View Full Code Here
243
244
245
246
247
248
249
250
251
252
253
    n = new Vector2f(-ndp.y, ndp.x);
    Vector2f v1 = new Vector2f(n);
    v1.scale(-body2.getInvMass() - body1.getInvMass());

    Vector2f v2 = MathUtil.cross(MathUtil.cross(r2, n), r2);
    v2.scale(-body2.getInvI());

    Vector2f v3 = MathUtil.cross(MathUtil.cross(R, n), r1);
    v3.scale(-body1.getInvI());

    Vector2f K1 = new Vector2f(v1);
View Full Code Here
246
247
248
249
250
251
252
253
254
255
256
    Vector2f v2 = MathUtil.cross(MathUtil.cross(r2, n), r2);
    v2.scale(-body2.getInvI());

    Vector2f v3 = MathUtil.cross(MathUtil.cross(R, n), r1);
    v3.scale(-body1.getInvI());

    Vector2f K1 = new Vector2f(v1);
    K1.add(v2);
    K1.add(v3);
View Full Code Here
TOP
Copyright © 2018 www.massapi.com. All rights reserved.
All source code are property of their respective owners. Java is a trademark of Sun Microsystems, Inc and owned by ORACLE Inc. Contact coftware#gmail.com.