public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, DVector3C C) { A.add0( dCalcVectorDot3(B, b+0, C) ); A.add1( dCalcVectorDot3(B, b+4, C) ); A.add2( dCalcVectorDot3(B, b+8, C) ); } public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, double[] C, int c) {
public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, DVector3C C) { A.add0( dCalcVectorDot3(B, b+0, C) ); A.add1( dCalcVectorDot3(B, b+4, C) ); A.add2( dCalcVectorDot3(B, b+8, C) ); } public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, double[] C, int c) {
public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, double[] C, int c) { A.add0( dCalcVectorDot3(B, b+0, C, c) ); A.add1( dCalcVectorDot3(B, b+4, C, c) ); A.add2( dCalcVectorDot3(B, b+8, C, c) ); } @Deprecated
public static void dMultiplyAdd0_331(DVector3 A, double[] B, int b, double[] C, int c) { A.add0( dCalcVectorDot3(B, b+0, C, c) ); A.add1( dCalcVectorDot3(B, b+4, C, c) ); A.add2( dCalcVectorDot3(B, b+8, C, c) ); } @Deprecated
/** * Cross product, set a -= b x c. * @param a a * @param b b * @param c c */ public static void dSubtractVectorCross3(DVector3 a, DVector3C b, DVector3C c) { a.add0( -b.get1()*c.get2() + b.get2()*c.get1() ); a.add1( -b.get2()*c.get0() + b.get0()*c.get2() ); a.add2( -b.get0()*c.get1() + b.get1()*c.get0() ); }
public static void dSubtractVectorCross3(DVector3 a, DVector3C b, DMatrix3C c) { a.add0( - (b.get1()*c.get02() - b.get2()*c.get01()) ); a.add1( - (b.get2()*c.get00() - b.get0()*c.get02()) ); a.add2( - (b.get0()*c.get01() - b.get1()*c.get00()) ); } // public static void dCROSS(DVector3 a, OP op, DVector3C b, DMatrix3C c) {
/** * Cross product, set a += b x c. * @param a a * @param b b * @param c c */ public static void dAddVectorCross3(DVector3 a, DVector3C b, DVector3C c) { a.add0( b.get1()*c.get2() - b.get2()*c.get1() ); a.add1( b.get2()*c.get0() - b.get0()*c.get2() ); a.add2( b.get0()*c.get1() - b.get1()*c.get0() ); } /**
public static void dSubtractVectorCross3(DVector3 a, DVector3C b, DMatrix3C c) { a.add0( - (b.get1()*c.get02() - b.get2()*c.get01()) ); a.add1( - (b.get2()*c.get00() - b.get0()*c.get02()) ); a.add2( - (b.get0()*c.get01() - b.get1()*c.get00()) ); } // public static void dCROSS(DVector3 a, OP op, DVector3C b, DMatrix3C c) {
/** * Cross product, set a += b x c. * @param a a * @param b b * @param c c */ public static void dAddVectorCross3(DVector3 a, DVector3C b, DVector3C c) { a.add0( b.get1()*c.get2() - b.get2()*c.get1() ); a.add1( b.get2()*c.get0() - b.get0()*c.get2() ); a.add2( b.get0()*c.get1() - b.get1()*c.get0() ); } /**
/** * Cross product, set a -= b x c. * @param a a * @param b b * @param c c */ public static void dSubtractVectorCross3(DVector3 a, DVector3C b, DVector3C c) { a.add0( -b.get1()*c.get2() + b.get2()*c.get1() ); a.add1( -b.get2()*c.get0() + b.get0()*c.get2() ); a.add2( -b.get0()*c.get1() + b.get1()*c.get0() ); }
b.lvel.add0( (cforce[cforcecurrP+0] + b.facc.get0()) * body_invMass_mul_stepsize); b.lvel.add1( (cforce[cforcecurrP+1] + b.facc.get1()) * body_invMass_mul_stepsize); b.lvel.add2( (cforce[cforcecurrP+2] + b.facc.get2()) * body_invMass_mul_stepsize);
b.lvel.add0( (cforce[cforcecurrP+0] + b.facc.get0()) * body_invMass_mul_stepsize); b.lvel.add1( (cforce[cforcecurrP+1] + b.facc.get1()) * body_invMass_mul_stepsize); b.lvel.add2( (cforce[cforcecurrP+2] + b.facc.get2()) * body_invMass_mul_stepsize);