Package javax.vecmath

Examples of javax.vecmath.Vector3f.sub()

138
139
140
141
142
143
144
145
146
147
148
      res2 = cross.lengthSquared();
    }

    if (maxPenetrationIndex != 3) {
      Vector3f a3 = Stack.alloc(pt.localPointA);
      a3.sub(pointCache[0].localPointA);

      Vector3f b3 = Stack.alloc(pointCache[2].localPointA);
      b3.sub(pointCache[1].localPointA);

      Vector3f cross = Stack.alloc(Vector3f.class);
View Full Code Here
141
142
143
144
145
146
147
148
149
150
151
    if (maxPenetrationIndex != 3) {
      Vector3f a3 = Stack.alloc(pt.localPointA);
      a3.sub(pointCache[0].localPointA);

      Vector3f b3 = Stack.alloc(pointCache[2].localPointA);
      b3.sub(pointCache[1].localPointA);

      Vector3f cross = Stack.alloc(Vector3f.class);
      cross.cross(a3, b3);
      res3 = cross.lengthSquared();
    }
View Full Code Here
218
219
220
221
222
223
224
225
226
227
228
    int nearestPoint = -1;
    Vector3f diffA = Stack.alloc(Vector3f.class);
    for (int i = 0; i < size; i++) {
      ManifoldPoint mp = pointCache[i];

      diffA.sub(mp.localPointA, newPoint.localPointA);

      float distToManiPoint = diffA.dot(diffA);
      if (distToManiPoint < shortestDist) {
        shortestDist = distToManiPoint;
        nearestPoint = i;
View Full Code Here
123
124
125
126
127
128
129
130
131
132
133
  public void calcNormal(Vector3f normal) {
    Vector3f tmp1 = Stack.alloc(Vector3f.class);
    Vector3f tmp2 = Stack.alloc(Vector3f.class);

    tmp1.sub(vertices1[1], vertices1[0]);
    tmp2.sub(vertices1[2], vertices1[0]);

    normal.cross(tmp1, tmp2);
    normal.normalize();
  }
View Full Code Here
155
156
157
158
159
160
161
162
163
164
165
      int i;
      for (i = 0; i < 3; i++) {
        Vector3f pa = Stack.alloc(Vector3f.class), pb = Stack.alloc(Vector3f.class);
        getEdge(i, pa, pb);
        Vector3f edge = Stack.alloc(Vector3f.class);
        edge.sub(pb, pa);
        Vector3f edgeNormal = Stack.alloc(Vector3f.class);
        edgeNormal.cross(edge, normal);
        edgeNormal.normalize();
        /*float*/ dist = pt.dot(edgeNormal);
        float edgeConst = pa.dot(edgeNormal);
View Full Code Here
69
70
71
72
73
74
75
76
77
78
79
    simplexSolver.reset();

    Vector3f linVelA = Stack.alloc(Vector3f.class);
    Vector3f linVelB = Stack.alloc(Vector3f.class);
    linVelA.sub(toA.origin, fromA.origin);
    linVelB.sub(toB.origin, fromB.origin);
   
    float lambda = 0f;
   
    Transform interpolatedTransA = Stack.alloc(fromA);
    Transform interpolatedTransB = Stack.alloc(fromB);
View Full Code Here
78
79
80
81
82
83
84
85
86
87
88
    Transform interpolatedTransA = Stack.alloc(fromA);
    Transform interpolatedTransB = Stack.alloc(fromB);

    // take relative motion
    Vector3f r = Stack.alloc(Vector3f.class);
    r.sub(linVelA, linVelB);
   
    Vector3f v = Stack.alloc(Vector3f.class);

    tmp.negate(r);
    MatrixUtil.transposeTransform(tmp, tmp, fromA.basis);
View Full Code Here
121
122
123
124
125
126
127
128
129
130
131
     
      MatrixUtil.transposeTransform(tmp, v, interpolatedTransB.basis);
      convexB.localGetSupportingVertex(tmp, supVertexB);
      interpolatedTransB.transform(supVertexB);
     
      w.sub(supVertexA, supVertexB);

      float VdotW = v.dot(w);

      if (lambda > 1f) {
        return false;
View Full Code Here
144
145
146
147
148
149
150
151
152
153
154
          //  x = s + lambda * r;
          VectorUtil.setInterpolate3(interpolatedTransA.origin, fromA.origin, toA.origin, lambda);
          VectorUtil.setInterpolate3(interpolatedTransB.origin, fromB.origin, toB.origin, lambda);
          //m_simplexSolver->reset();
          // check next line
          w.sub(supVertexA, supVertexB);
          lastLambda = lambda;
          n.set(v);
          hasResult = true;
        }
      }
View Full Code Here
81
82
83
84
85
86
87
88
89
90
91
    Vector3f aabbCenter = Stack.alloc(Vector3f.class);
    aabbCenter.add(aabbMax, aabbMin);
    aabbCenter.scale(0.5f);

    Vector3f scaledAabbHalfExtends = Stack.alloc(Vector3f.class);
    scaledAabbHalfExtends.sub(aabbMax, aabbMin);
    scaledAabbHalfExtends.scale(0.5f * uniformScalingFactor);

    aabbMin.sub(aabbCenter, scaledAabbHalfExtends);
    aabbMax.add(aabbCenter, scaledAabbHalfExtends);
  }
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.