public void dBodyAddForce (double fx, double fy, double fz) { facc.add(fx, fy, fz); } public void dBodyAddForce (DVector3C f)
public void dBodyAddTorque (double fx, double fy, double fz) { tacc.add(fx, fy, fz); } public void dBodyAddTorque (DVector3C f)
public void dBodyAddForce (double fx, double fy, double fz) { facc.add(fx, fy, fz); } public void dBodyAddForce (DVector3C f)
/** * Returns a new vector with the sum of (this)+c. * @param c c * @return new vector */ public final DVector3C reAdd(DVector3C c) { return new DVector3(this).add(c); }
void TransformVector3( DVector3C in, DMatrix3C orientation, DVector3C position, DVector3 out ) { OdeMath.dMultiply0_331( out, orientation, in ); // out[0] += position[0]; // out[1] += position[1]; // out[2] += position[2]; out.add(position); }
/** * Returns a new vector with the sum of (this)+c. * @param c c * @return new vector */ public final DVector3C reAdd(DVector3C c) { return new DVector3(this).add(c); }
void TransformVector3( DVector3C in, DMatrix3C orientation, DVector3C position, DVector3 out ) { OdeMath.dMultiply0_331( out, orientation, in ); // out[0] += position[0]; // out[1] += position[1]; // out[2] += position[2]; out.add(position); }
void dBodyAddRelForce (DVector3C f) { DVector3 t2 = new DVector3(); dMultiply0_331 (t2,_posr.R(),f); facc.add(t2); }
void dBodyAddForceAtPos (DVector3C f, DVector3C p) { facc.add(f); DVector3 q = p.reSub(_posr.pos()); dAddVectorCross3 (tacc,q,f); }
void dBodyAddRelForce (DVector3C f) { DVector3 t2 = new DVector3(); dMultiply0_331 (t2,_posr.R(),f); facc.add(t2); }
public void dBodyAddRelTorque (DVector3C f) { DVector3 t2 = new DVector3(); dMultiply0_331 (t2,_posr.R(),f); tacc.add(t2); }
void dBodyAddForceAtPos (DVector3C f, DVector3C p) { facc.add(f); DVector3 q = p.reSub(_posr.pos()); dAddVectorCross3 (tacc,q,f); }
void dBodyAddForceAtRelPos (DVector3C f, DVector3C prel) { DVector3 p = new DVector3(); dMultiply0_331 (p,_posr.R(),prel); facc.add(f); dAddVectorCross3 (tacc,p,f); }
void dBodyAddForceAtRelPos (DVector3C f, DVector3C prel) { DVector3 p = new DVector3(); dMultiply0_331 (p,_posr.R(),prel); facc.add(f); dAddVectorCross3 (tacc,p,f); }
void getAnchor( DVector3 result, DVector3 anchor1 ) { DxBody b0 = node[0].body; if ( b0 != null) { dMultiply0_331( result, b0.posr().R(), anchor1 ); // result.v[0] += node[0].body._posr.pos.v[0]; // result.v[1] += node[0].body._posr.pos.v[1]; // result.v[2] += node[0].body._posr.pos.v[2]; result.add(b0.posr().pos()); } }
void getAnchor( DVector3 result, DVector3 anchor1 ) { DxBody b0 = node[0].body; if ( b0 != null) { dMultiply0_331( result, b0.posr().R(), anchor1 ); // result.v[0] += node[0].body._posr.pos.v[0]; // result.v[1] += node[0].body._posr.pos.v[1]; // result.v[2] += node[0].body._posr.pos.v[2]; result.add(b0.posr().pos()); } }
void dBodyAddRelForceAtPos (DVector3C frel, DVector3C p) { DVector3 f = new DVector3(); dMultiply0_331 (f,_posr.R(),frel); facc.add(f); DVector3 q = p.reSub(_posr.pos()); dAddVectorCross3 (tacc,q,f); }
void dBodyAddRelForceAtPos (DVector3C frel, DVector3C p) { DVector3 f = new DVector3(); dMultiply0_331 (f,_posr.R(),frel); facc.add(f); DVector3 q = p.reSub(_posr.pos()); dAddVectorCross3 (tacc,q,f); }