Package javax.vecmath

Examples of javax.vecmath.Vector3f.sub()


   
    Vector3f s1 = new Vector3f(a);
    Vector3f s2 = new Vector3f(b);
   
    s1.sub(base);
    s2.sub(base);
   
    Vector3f n = new Vector3f();
    n.cross(s1, s2);
   
    n.normalize();
View Full Code Here


      manifoldPoint.positionWorldOnB.set(manifoldPoint.localPointB);
      trB.transform(manifoldPoint.positionWorldOnB);

      tmp.set(manifoldPoint.positionWorldOnA);
      tmp.sub(manifoldPoint.positionWorldOnB);
      manifoldPoint.distance1 = tmp.dot(manifoldPoint.normalWorldOnB);

      manifoldPoint.lifeTime++;
    }
View Full Code Here

      }
      else {
        // contact also becomes invalid when relative movement orthogonal to normal exceeds margin
        tmp.scale(manifoldPoint.distance1, manifoldPoint.normalWorldOnB);
        projectedPoint.sub(manifoldPoint.positionWorldOnA, tmp);
        projectedDifference.sub(manifoldPoint.positionWorldOnB, projectedPoint);
        distance2d = projectedDifference.dot(projectedDifference);
        if (distance2d > getContactBreakingThreshold() * getContactBreakingThreshold()) {
          removeContactPoint(i);
        }
        else {
View Full Code Here

    Vector3f vert0 = triangle[0];
    Vector3f vert1 = triangle[1];
    Vector3f vert2 = triangle[2];

    Vector3f v10 = Stack.alloc(Vector3f.class);
    v10.sub(vert1, vert0);

    Vector3f v20 = Stack.alloc(Vector3f.class);
    v20.sub(vert2, vert0);

    Vector3f triangleNormal = Stack.alloc(Vector3f.class);
View Full Code Here

    Vector3f v10 = Stack.alloc(Vector3f.class);
    v10.sub(vert1, vert0);

    Vector3f v20 = Stack.alloc(Vector3f.class);
    v20.sub(vert2, vert0);

    Vector3f triangleNormal = Stack.alloc(Vector3f.class);
    triangleNormal.cross(v10, v20);

    float dist = vert0.dot(triangleNormal);
View Full Code Here

      edge_tolerance *= -0.0001f;
      Vector3f point = new Vector3f();
      VectorUtil.setInterpolate3(point, from, to, distance);
      {
        Vector3f v0p = Stack.alloc(Vector3f.class);
        v0p.sub(vert0, point);
        Vector3f v1p = Stack.alloc(Vector3f.class);
        v1p.sub(vert1, point);
        Vector3f cp0 = Stack.alloc(Vector3f.class);
        cp0.cross(v0p, v1p);

View Full Code Here

      VectorUtil.setInterpolate3(point, from, to, distance);
      {
        Vector3f v0p = Stack.alloc(Vector3f.class);
        v0p.sub(vert0, point);
        Vector3f v1p = Stack.alloc(Vector3f.class);
        v1p.sub(vert1, point);
        Vector3f cp0 = Stack.alloc(Vector3f.class);
        cp0.cross(v0p, v1p);

        if (cp0.dot(triangleNormal) >= edge_tolerance) {
          Vector3f v2p = Stack.alloc(Vector3f.class);
View Full Code Here

        Vector3f cp0 = Stack.alloc(Vector3f.class);
        cp0.cross(v0p, v1p);

        if (cp0.dot(triangleNormal) >= edge_tolerance) {
          Vector3f v2p = Stack.alloc(Vector3f.class);
          v2p.sub(vert2, point);
          Vector3f cp1 = Stack.alloc(Vector3f.class);
          cp1.cross(v1p, v2p);
          if (cp1.dot(triangleNormal) >= edge_tolerance) {
            Vector3f cp2 = Stack.alloc(Vector3f.class);
            cp2.cross(v2p, v0p);
View Full Code Here

              localTransA, localTransB,
              cachedSeparatingAxis, tmpPointOnA, tmpPointOnB,
              debugDraw/*,input.stackAlloc*/);

          if (isValid2) {
            tmpNormalInB.sub(tmpPointOnB, tmpPointOnA);

            float lenSqr = tmpNormalInB.lengthSquared();
            if (lenSqr > (BulletGlobals.FLT_EPSILON * BulletGlobals.FLT_EPSILON)) {
              tmpNormalInB.scale(1f / (float) Math.sqrt(lenSqr));
              tmp.sub(tmpPointOnA, tmpPointOnB);
View Full Code Here

    Vector3f n = Stack.alloc(Vector3f.class);
    n.set(0f, 0f, 0f);
    boolean hasResult = false;
    Vector3f c = Stack.alloc(Vector3f.class);
    Vector3f r = Stack.alloc(Vector3f.class);
    r.sub(linVelA, linVelB);

    float lastLambda = lambda;
    //btScalar epsilon = btScalar(0.001);

    int numIter = 0;
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.