public class Frame extends DynamicComponentBase implements TransformableGeometry, ScalableUnits, DynamicComponent, Traceable, MotionTargetComponent, CopyableComponent, HasCoordinateFrame, CollidableDynamicComponent, PointAttachable, FrameAttachable
| Modifier and Type | Field and Description |
|---|---|
static boolean |
dynamicVelInWorldCoords |
static PropertyList |
myProps |
RigidTransform3d |
myRenderFrame |
enforceUniqueCompositeNames, enforceUniqueNames, myNumber, NULL_OBJ, useCompactPathNamesCOPY_REFERENCESTG_ARTICULATED, TG_DRAGGER, TG_PRESERVE_ORIENTATION, TG_SIMULATINGTRANSPARENT, TWO_DIMENSIONAL| Constructor and Description |
|---|
Frame() |
Frame(RigidTransform3d X) |
| Modifier and Type | Method and Description |
|---|---|
void |
addEffectivePointMass(double m,
Vector3d loc)
Adds a point mass to the effective spatial inertia for this Frame.
|
void |
addExternalForce(Wrench w) |
void |
addForce(Wrench w) |
void |
addPointForce(Point3d loc,
Vector3d f)
Adds to this body's forces the wrench arising from applying a force
f on a point loc. |
void |
addPointForce(Wrench wr,
Point3d loc,
Vector3d f)
Adds to
wr the wrench arising from applying a force
f on a point loc. |
void |
addPointMass(Matrix M,
double m,
Vector3d loc)
Adds a point mass to a matrix that contains the spatial
inertia for this Frame.
|
void |
addPosImpulse(double[] xbuf,
int xidx,
double h,
double[] vbuf,
int vidx) |
void |
addPosJacobian(SparseNumberedBlockMatrix S,
double s)
Scales the components of the position Jacobian associated with this force
effector and adds it to the supplied solve matrix M.
|
void |
addScaledExternalForce(double s,
Wrench w) |
void |
addSolveBlock(SparseNumberedBlockMatrix S) |
void |
addSolveBlocks(SparseNumberedBlockMatrix S)
Adds any needed blocks to a solve matrix in order to accomodate the
Jacobian terms associated with this force effector.
|
int |
addTargetJacobian(SparseBlockMatrix J,
int bi)
Add a row to the motion target Jacobian for this motion target.
|
void |
addToPointVelocity(Vector3d vel,
double w,
ContactPoint cpnt)
Computes the velocity imparted to a contact point by this component's
current velocity, multiples it by a weighting factor
w,
and add it to vel. |
void |
addTransformableDependencies(TransformGeometryContext context,
int flags)
Adds to
context any transformable components which should be
transformed as the same time as this component. |
void |
addVelJacobian(SparseNumberedBlockMatrix S,
double s)
Scales the components of the velocity Jacobian associated with this force
effector and adds it to the supplied solve matrix M.
|
void |
applyExternalForces() |
void |
applyForces(double t)
Adds forces to the components affected by this force effector at a
particular time.
|
void |
applyGravity(Vector3d gacc)
Applies a gravity force to this component, given a prescribed
gravity acceleration vector.
|
void |
computeAppliedWrench(Wrench wr,
Vector3d f,
Vector3d p)
Computes the wrench (in body coordinates) produced by applying a
force at a particular point.
|
void |
computeLocalPointForceJacobian(MatrixBlock GT,
Vector3d loc,
RotationMatrix3d R)
Computes a force Jacobian for a point attached to this frame, and then
optionally rotates its columns using a rotation matrix R.
|
void |
computePointCoriolis(Vector3d cor,
Vector3d loc)
Computes the velocity derivative of a point attached to this frame
that is due to the current velocity of the frame.
|
void |
computePointLocation(Vector3d loc,
Vector3d pos)
Computes the location, in body coordinates, of a point whose position
is given in world coordinates.
|
void |
computePointPosition(Vector3d pos,
Point3d loc)
Computes the position, in world coordinates, of a point attached to this
frame.
|
void |
computePointVelocity(Vector3d vel,
Point3d loc)
Computes the velocity, in world coordinates, of a point attached to this
frame.
|
void |
computePointVelocity(Vector3d vel,
Point3d loc,
Twist frameVel)
Computes the velocity, in world coordinates, of a point attached to this
frame.
|
void |
computePointVelocity(Vector3d vel,
Point3d loc,
Vector3d pvel)
Computes the velocity, in world coordinates, of a point attached to this
frame.
|
void |
computeWorldPointForceJacobian(MatrixBlock GT,
Point3d loc)
Computes the force Jacobian, in world coordinates, for a point attached
to this frame.
|
Frame |
copy(int flags,
java.util.Map<ModelComponent,ModelComponent> copyMap)
Create a copy of this component.
|
FrameFrameAttachment |
createFrameAttachment(Frame frame,
RigidTransform3d TFW)
Returns a FrameAttachment that attaches a
frame to this
component. |
MatrixBlock |
createMassBlock()
Create a matrix block for representing the mass of this component,
initialized to the component's effective mass (instrinsic mass
plus the mass due to all attachmented components).
|
PointFrameAttachment |
createPointAttachment(Point pnt)
Returns a PointAttachment that attaches
pnt
to this component. |
RenderProps |
createRenderProps()
Factory method to create render properties appropriate to this object.
|
PropertyList |
getAllPropertyInfo()
Returns a list giving static information about all properties exported by
this object.
|
double |
getAxisLength() |
void |
getBodyForce(Wrench wr) |
void |
getBodyVelocity(Twist v) |
int |
getBodyVelState(double[] buf,
int idx) |
boolean |
getCopyReferences(java.util.List<ModelComponent> refs,
ModelComponent ancestor)
Collects external references which must also be copied in order to
duplicate this component.
|
void |
getEffectiveMass(Matrix M,
double t)
Gets the effective mass of this component at a particular time.
|
int |
getEffectiveMassForces(VectorNd f,
double t,
int idx)
Gets the mass forces for this component at a particular time.
|
Wrench |
getExternalForce() |
Wrench |
getForce() |
int |
getForce(double[] f,
int idx) |
void |
getForce(Wrench wr) |
double |
getFrameDamping() |
PropertyMode |
getFrameDampingMode() |
int |
getJacobianType()
Returns a code indicating the matrix type that results when the Jacobian
terms of this force effector are added to the solve matrix.
|
double |
getMass(double t)
Returns the scalar mass of this component at time t.
|
void |
getMass(Matrix M,
double t)
Gets the mass of this component at a particular time.
|
Vector3d |
getMoment() |
AxisAngle |
getOrientation() |
void |
getOrientation(AxisAngle axisAng) |
int |
getPosDerivative(double[] dxdt,
int idx) |
RigidTransform3d |
getPose() |
void |
getPose(RigidTransform3d XFrameToWorld) |
Point3d |
getPosition() |
int |
getPosState(double[] buf,
int idx) |
int |
getPosStateSize() |
double |
getRotaryDamping() |
PropertyMode |
getRotaryDampingMode() |
Quaternion |
getRotation() |
void |
getSelection(java.util.LinkedList<java.lang.Object> list,
int qid)
Append to
list the component (or components) associated with
the qid-th selection query issued by this component's render
method. |
MotionTarget.TargetActivity |
getTargetActivity() |
AxisAngle |
getTargetOrientation() |
int |
getTargetPos(double[] post,
double s,
double h,
int idx) |
RigidTransform3d |
getTargetPose() |
Point3d |
getTargetPosition() |
int |
getTargetVel(double[] velt,
double s,
double h,
int idx) |
Twist |
getTargetVelocity() |
java.lang.String |
getTraceablePositionProperty(java.lang.String traceableName)
For a given traceable property, returns the name of a property (if any)
which provides a reference position to be used for the traceable property.
|
java.lang.String[] |
getTraceables()
Returns a list of all traceable properties in this Traceable.
|
Vector3d |
getTransForce() |
Twist |
getVelocity() |
void |
getVelocity(Twist v) |
int |
getVelState(double[] buf,
int idx) |
int |
getVelStateSize() |
int |
getWorldVelState(double[] buf,
int idx) |
boolean |
isDuplicatable()
Returns true if this component can be duplicated.
|
boolean |
isMassConstant() |
int |
mulInverseEffectiveMass(Matrix M,
double[] a,
double[] f,
int idx) |
void |
prerender(RenderList list)
Called prior to rendering to allow this object to update the internal
state required for rendering (such as by caching rendering coordinates).
|
void |
render(Renderer renderer,
int flags)
Render this object using the functionality of the supplied
Renderer. |
void |
resetEffectiveMass()
Resets the effective mass of this component to the nominal mass.
|
void |
resetTargets() |
void |
scaleDistance(double s)
Scales all distance coordinates.
|
void |
scaleMass(double s)
Scales all mass units.
|
void |
setAxisLength(double len) |
void |
setBodyVelocity(Twist v) |
void |
setContactConstraint(double[] buf,
double w,
Vector3d dir,
ContactPoint cpnt)
Computes the values for the block matrix which defines this component's
contribution to a contact constraint matrix.
|
void |
setExternalForce(Wrench w) |
int |
setForce(double[] f,
int idx) |
void |
setForce(Wrench w) |
void |
setFrameDamping(double d) |
void |
setFrameDampingMode(PropertyMode mode) |
void |
setOrientation(AxisAngle axisAng) |
void |
setPose(RigidTransform3d XFrameToWorld) |
void |
setPosition(Point3d pos) |
int |
setPosState(double[] buf,
int idx) |
void |
setRotaryDamping(double d) |
void |
setRotaryDampingMode(PropertyMode mode) |
void |
setRotation(Quaternion q) |
void |
setState(Frame frame) |
void |
setTargetActivity(MotionTarget.TargetActivity activity) |
void |
setTargetOrientation(AxisAngle axisAng) |
int |
setTargetPos(double[] post,
int idx) |
void |
setTargetPose(RigidTransform3d X) |
void |
setTargetPosition(Point3d pos) |
int |
setTargetVel(double[] velt,
int idx) |
void |
setTargetVelocity(Twist vel) |
void |
setVelocity(double vx,
double vy,
double vz,
double wx,
double wy,
double wz) |
void |
setVelocity(Twist v) |
int |
setVelState(double[] buf,
int idx) |
void |
subPointForce(Point3d loc,
Vector3d f)
Subtracts from this body's forces the wrench arising from applying a force
f on a point loc. |
void |
subPointForce(Wrench wr,
Point3d loc,
Vector3d f)
Subtracts from
wr the wrench arising from applying a force
f on a point loc. |
void |
transformGeometry(GeometryTransformer gtr,
TransformGeometryContext context,
int flags)
Transforms the geometry of this component, using the geometry transformer
gtr to transform its individual attributes. |
void |
transformPose(RigidTransform3d T) |
void |
updateBounds(Vector3d pmin,
Vector3d pmax)
Update the minimum and maximum points for this object.
|
boolean |
velocityLimitExceeded(double tlimit,
double rlimit)
Checks if the current component velocity exceeds specified limits.
|
void |
zeroExternalForces() |
void |
zeroForces() |
addConstrainer, addMasterAttachment, getAttachment, getConstrainers, getInverseMass, getMasterAttachments, getSolveIndex, hasState, isActive, isAttached, isControllable, isDynamic, isParametric, removeConstrainer, removeMasterAttachment, setAttached, setSolveIndex, transformGeometrygetRenderHints, getRenderProps, isSelectable, numSelectionQueriesNeeded, setRenderProps, updateRenderPropscheckFlag, checkName, checkNameUniqueness, clearFlag, clone, connectToHierarchy, createTempFlag, disconnectFromHierarchy, getChildren, getGrandParent, getHardReferences, getName, getNameRange, getNavpanelVisibility, getNavpanelVisibility, getNumber, getParent, getProperty, getSoftReferences, hasChildren, isConnectedToHierarchy, isFixed, isMarked, isSelected, isWritable, makeValidName, makeValidName, notifyParentOfChange, postscan, printReferences, recursivelyContained, recursivelyContains, removeTempFlag, scan, setFixed, setFlag, setMarked, setName, setNavpanelVisibility, setNavpanelVisibility, setNumber, setParent, setSelected, updateReferences, writeequals, getClass, hashCode, notify, notifyAll, toString, wait, wait, waitaddConstrainer, addMasterAttachment, checkFlag, clearFlag, getAttachment, getConstrainers, getInverseMass, getMasterAttachments, getSolveIndex, isActive, isAttached, isControllable, isDynamic, isParametric, removeConstrainer, removeMasterAttachment, setAttached, setFlag, setSolveIndextransformGeometrypublic static boolean dynamicVelInWorldCoords
public RigidTransform3d myRenderFrame
public static PropertyList myProps
public Frame()
public Frame(RigidTransform3d X)
public PropertyList getAllPropertyInfo()
HasPropertiesgetAllPropertyInfo in interface HasPropertiesgetAllPropertyInfo in class ModelComponentBasepublic Wrench getForce()
public void getForce(Wrench wr)
public void getBodyForce(Wrench wr)
public Vector3d getTransForce()
public Vector3d getMoment()
public void setForce(Wrench w)
public void addForce(Wrench w)
public Wrench getExternalForce()
public void setExternalForce(Wrench w)
public void addExternalForce(Wrench w)
public void addScaledExternalForce(double s,
Wrench w)
public Twist getVelocity()
public void getVelocity(Twist v)
public void setVelocity(Twist v)
public void setVelocity(double vx,
double vy,
double vz,
double wx,
double wy,
double wz)
public void setPose(RigidTransform3d XFrameToWorld)
public void transformPose(RigidTransform3d T)
public RigidTransform3d getPose()
public void getPose(RigidTransform3d XFrameToWorld)
getPose in interface HasCoordinateFramepublic Point3d getPosition()
public void setPosition(Point3d pos)
public AxisAngle getOrientation()
public void getOrientation(AxisAngle axisAng)
public void setOrientation(AxisAngle axisAng)
public Quaternion getRotation()
public void setRotation(Quaternion q)
public void applyGravity(Vector3d gacc)
applyGravity in interface DynamicComponentpublic double getAxisLength()
public void setAxisLength(double len)
public void computePointPosition(Vector3d pos, Point3d loc)
pos - returns the point positionloc - position of the point, in body coordinatespublic void computePointLocation(Vector3d loc, Vector3d pos)
computePointPosition(maspack.matrix.Vector3d, maspack.matrix.Point3d).loc - returns the point locationpos - position of the point, in world coordinatespublic void computePointVelocity(Vector3d vel, Point3d loc)
vel - returns the point velocityloc - position of the point, in body coordinatespublic void addPointMass(Matrix M, double m, Vector3d loc)
M - matrix containing existing spatial inertiam - mass of the pointloc - location of the point (in local frame coordinates)public void computeWorldPointForceJacobian(MatrixBlock GT, Point3d loc)
[ I ] [ ] [ [ R loc ] ]where I is the 3x3 identity matrix, R is the frame orientation matrix, and [ x ] denotes the 3x3 skew-symmetric cross product matrix.
GT - returns the force Jacobianloc - position of the point, in body coordinatespublic void computeLocalPointForceJacobian(MatrixBlock GT, Vector3d loc, RotationMatrix3d R)
null, then the Jacobian
takes the following form for the 6x3 matrix case:
[ I ] [ ] [ [ RF loc ] ]where RF is the frame orientation matrix, loc is the location of the point in frame coordinates, and [ x ] denotes the 3x3 skew-symmetric cross product matrix. If the rotation matrix R is not
null, then the
6x3 case takes the following form:
[ R ] [ ] [ [ RF loc ] R ]
GT - returns the force Jacobianloc - location of the point, relative to the frameR - optional rotation transformpublic void computePointVelocity(Vector3d vel, Point3d loc, Twist frameVel)
vel - returns the point velocityloc - position of the point, in body coordinatesframeVel - velocity of the frame, in rotated world coordinatespublic void computePointVelocity(Vector3d vel, Point3d loc, Vector3d pvel)
vel - returns the point velocityloc - position of the point, in body coordinatespvel - independent velocity for the point, in body coordinatespublic void computePointCoriolis(Vector3d cor, Vector3d loc)
cor - returns the point Coriolis term (in world coordinates)loc - position of the point, in body coordinatespublic void subPointForce(Wrench wr, Point3d loc, Vector3d f)
wr the wrench arising from applying a force
f on a point loc.wr - wrench from which force is subtracted (world coordinatesloc - location of the point (body coordinates)f - force acting on the point (world coordinates)public void addPointForce(Wrench wr, Point3d loc, Vector3d f)
wr the wrench arising from applying a force
f on a point loc.wr - wrench in which force is accumulated (world coordinatesloc - location of the point (body coordinates)f - force applied to the point (world coordinates)public void addPointForce(Point3d loc, Vector3d f)
f on a point loc.loc - location of the point (body coordinates)f - force applied to the point (world coordinates)public void subPointForce(Point3d loc, Vector3d f)
f on a point loc.loc - location of the point (body coordinates)f - force applied to the point (world coordinates)public void computeAppliedWrench(Wrench wr, Vector3d f, Vector3d p)
wr - returns the wrench in body coordinatesf - applied force at the point (world coordinates)p - location of the point on the body (body coordinates)public void resetTargets()
resetTargets in interface MotionTargetComponentpublic MotionTarget.TargetActivity getTargetActivity()
getTargetActivity in interface MotionTargetComponentpublic void setTargetActivity(MotionTarget.TargetActivity activity)
setTargetActivity in interface MotionTargetComponentpublic Point3d getTargetPosition()
public void setTargetPosition(Point3d pos)
public AxisAngle getTargetOrientation()
public void setTargetOrientation(AxisAngle axisAng)
public RigidTransform3d getTargetPose()
public void setTargetPose(RigidTransform3d X)
public Twist getTargetVelocity()
public void setTargetVelocity(Twist vel)
public int getTargetVel(double[] velt,
double s,
double h,
int idx)
getTargetVel in interface MotionTargetComponentpublic int setTargetVel(double[] velt,
int idx)
setTargetVel in interface MotionTargetComponentpublic int getTargetPos(double[] post,
double s,
double h,
int idx)
getTargetPos in interface MotionTargetComponentpublic int setTargetPos(double[] post,
int idx)
setTargetPos in interface MotionTargetComponentpublic int addTargetJacobian(SparseBlockMatrix J, int bi)
MotionTargetComponentvt = J u
addTargetJacobian in interface MotionTargetComponentJ - motion target Jacobianbi - block row index for the row to be addedpublic double getFrameDamping()
public void setFrameDamping(double d)
public PropertyMode getFrameDampingMode()
public void setFrameDampingMode(PropertyMode mode)
public double getRotaryDamping()
public void setRotaryDamping(double d)
public PropertyMode getRotaryDampingMode()
public void setRotaryDampingMode(PropertyMode mode)
public RenderProps createRenderProps()
HasRenderPropscreateRenderProps in interface HasRenderPropscreateRenderProps in class RenderableComponentBasepublic void prerender(RenderList list)
IsRenderablelist.addIfVisible (obj);
for each of the objects in question.prerender in interface IsRenderableprerender in class RenderableComponentBaselist - list of objects to be renderedpublic void updateBounds(Vector3d pmin, Vector3d pmax)
IsRenderableupdateBounds in interface IsRenderableupdateBounds in class RenderableComponentBasepmin - minimum pointpmax - maximum pointpublic void render(Renderer renderer, int flags)
IsRenderableRenderer.render in interface IsRenderablerender in class RenderableComponentBaserenderer - provides the functionality used to perform the rendering.flags - flags that may be used to control different
aspects of the rendering. Flags are defined in Renderer
and currently include
Renderer.HIGHLIGHT and
Renderer.SORT_FACES.public void getSelection(java.util.LinkedList<java.lang.Object> list,
int qid)
IsSelectablelist the component (or components) associated with
the qid-th selection query issued by this component's render
method. This will only be called if this component manages its own
selection (i.e., the number nums returned by IsSelectable.numSelectionQueriesNeeded() is positive), and qid will in
turn be a number between 0 and nums-1.getSelection in interface IsSelectablegetSelection in class RenderableComponentBaselist - selected objects are appended to the end of this listqid - index of the selection querypublic void transformGeometry(GeometryTransformer gtr, TransformGeometryContext context, int flags)
TransformableGeometrygtr to transform its individual attributes. The
context argument supplies information about what other
components are currently being transformed, and also allows the
requesting of update actions to be performed after all transform called
have completed. The context is also the usual entity that calls
this method, from within its TransformGeometryContext.apply(maspack.geometry.GeometryTransformer, int)
method. The argument flags provides flags to specify
various conditions associated with the the transformation.
At present, the available flags are TransformableGeometry.TG_SIMULATING and
TransformableGeometry.TG_ARTICULATED.
This method is not usually called directly by applications.
Instead, it is typically called from within the
TransformGeometryContext.apply(maspack.geometry.GeometryTransformer, int) method of the context,
which takes care of the various operations needed for a
complete transform operation, including calling
TransformableGeometry.addTransformableDependencies(artisynth.core.modelbase.TransformGeometryContext, int) to collect other
components that should be transformed, calling
TransformableGeometry.transformGeometry(maspack.matrix.AffineTransform3dBase) for each component, notifying
component parents that the geometry has changed, and calling
any requested TransformGeometryActions. More details
are given in the documentation for
TransformGeometryContext.apply(maspack.geometry.GeometryTransformer, int).
TransformGeometryContext provides a number of
static convenience transform methods
which take care of building the context and calling
apply() for a specified set of components.
This method should not
generally call transformGeometry() for its descendant
components. Instead, descendants needing transformation should be
specified by adding them to the context in the method TransformableGeometry.addTransformableDependencies(artisynth.core.modelbase.TransformGeometryContext, int).
transformGeometry in interface TransformableGeometrytransformGeometry in class DynamicComponentBasegtr - transformer implementing the transformcontext - context information, including what other components
are being transformedflags - specifies conditions associated with the transformationpublic void addTransformableDependencies(TransformGeometryContext context, int flags)
TransformableGeometrycontext any transformable components which should be
transformed as the same time as this component. This will generally
include descendant components, and may also include other components to
which this component is connected in some way.
This method is generally called from with the
TransformGeometryContext.apply(maspack.geometry.GeometryTransformer, int) method of a
TransformGeometryContext.
addTransformableDependencies in interface TransformableGeometryaddTransformableDependencies in class DynamicComponentBasecontext - context information, to which the dependent components
are added.flags - specifies conditions associated with the transformationpublic void scaleDistance(double s)
ScalableUnitsscaleDistance in interface ScalableUnitss - scaling factorpublic void zeroExternalForces()
zeroExternalForces in interface DynamicComponentpublic void zeroForces()
zeroForces in interface DynamicComponentpublic void applyExternalForces()
applyExternalForces in interface DynamicComponentpublic void applyForces(double t)
ForceEffectorapplyForces in interface ForceEffectort - time (seconds)public void addVelJacobian(SparseNumberedBlockMatrix S, double s)
ForceEffector
M is guaranteed to be the same matrix supplied in the most recent call to
addSolveBlocks, and so implementations may choose
to cache the relevant matrix blocks from that call, instead of retrieving
them directly from M.
addVelJacobian in interface ForceEffectorS - solve matrix to which scaled velocity Jacobian is to be addeds - scaling factor for velocity Jacobianpublic void addPosJacobian(SparseNumberedBlockMatrix S, double s)
ForceEffector
M is guaranteed to be the same matrix supplied in the most recent call to
addSolveBlocks, and so implementations may choose
to cache the relevant matrix blocks from that call, instead of retrieving
them directly from M.
addPosJacobian in interface ForceEffectorS - solve matrix to which scaled position Jacobian is to be addeds - scaling factor for position Jacobianpublic void addSolveBlocks(SparseNumberedBlockMatrix S)
ForceEffectorgetSolveIndex) for all dynamic or attached components affected by this
force effector.addSolveBlocks in interface ForceEffectorS - solve matrix to which blocks should be addedpublic int getJacobianType()
ForceEffectorMatrix.SYMMETRIC or Matrix.POSITIVE_DEFINITE. The former should be set if adding the Jacobian
terms preserves symmetry, and the latter should be set if positive
definiteness if preserved. Both should be set if there is no Jacobian for
this effector (i.e., the Jacobian methods are not implemented). Matrix
types from all the force effectors are logically and-ed together to
determine the type for the entire solve matrix.getJacobianType in interface ForceEffectorpublic void scaleMass(double s)
ScalableUnitsscaleMass in interface ScalableUnitss - scaling factorpublic MatrixBlock createMassBlock()
DynamicComponentcreateMassBlock in interface DynamicComponentpublic boolean isMassConstant()
isMassConstant in interface DynamicComponentpublic double getMass(double t)
DynamicComponentgetMass in interface DynamicComponentpublic void getMass(Matrix M, double t)
DynamicComponentgetMass in interface DynamicComponentM - matrix to return the mass int - current timepublic void getEffectiveMass(Matrix M, double t)
DynamicComponentgetEffectiveMass in interface DynamicComponentM - matrix to return the mass int - current timepublic int mulInverseEffectiveMass(Matrix M, double[] a, double[] f, int idx)
mulInverseEffectiveMass in interface DynamicComponentpublic void resetEffectiveMass()
DynamicComponentresetEffectiveMass in interface DynamicComponentpublic void addEffectivePointMass(double m,
Vector3d loc)
m - mass of the pointloc - location of the point (in local frame coordinates)public int getEffectiveMassForces(VectorNd f, double t, int idx)
DynamicComponentf, starting at the location
specified by idx. Upon return, this method should
return the value of idx incremented by the dimension
of the mass forces.getEffectiveMassForces in interface DynamicComponentf - vector to return the forces int - current timeidx - starting location within f
where forces should be storedidxpublic void addSolveBlock(SparseNumberedBlockMatrix S)
addSolveBlock in interface DynamicComponentaddSolveBlock in class DynamicComponentBasepublic void setState(Frame frame)
public int getPosState(double[] buf,
int idx)
getPosState in interface DynamicComponentpublic int setPosState(double[] buf,
int idx)
setPosState in interface DynamicComponentpublic void addPosImpulse(double[] xbuf,
int xidx,
double h,
double[] vbuf,
int vidx)
addPosImpulse in interface DynamicComponentpublic int getPosDerivative(double[] dxdt,
int idx)
getPosDerivative in interface DynamicComponentpublic int getVelState(double[] buf,
int idx)
getVelState in interface DynamicComponentpublic int getBodyVelState(double[] buf,
int idx)
public int getWorldVelState(double[] buf,
int idx)
public int setVelState(double[] buf,
int idx)
setVelState in interface DynamicComponentpublic int setForce(double[] f,
int idx)
setForce in interface DynamicComponentpublic int getForce(double[] f,
int idx)
getForce in interface DynamicComponentpublic Frame copy(int flags, java.util.Map<ModelComponent,ModelComponent> copyMap)
CopyableComponentCOPY_REFERENCES
is set in flags, then any component referenced
by this component should itself be set to a copy. This
should be done first checking copyMap for an
existing copy of the referenced component. If there is no existing
copy, then a copy should be created by calling copy
recursively and adding the new copy to copyMap.copy in interface CopyableComponentcopy in class DynamicComponentBaseflags - flags to control the copyingcopyMap - map to possible existing instances of referenced
componentspublic void setBodyVelocity(Twist v)
public void getBodyVelocity(Twist v)
public java.lang.String[] getTraceables()
getTraceables in interface Traceablepublic java.lang.String getTraceablePositionProperty(java.lang.String traceableName)
+ or
- character, which is used to control the rendering
of the tracing probe in case the traceable property is a 3-vector.
A prepended + character means that the vector will
be rendered starting at, and directed away from the reference
position (or render as pull), while a + character
means that the vector will be rendered starting away from, and
directed into the reference position (or render as push).getTraceablePositionProperty in interface Traceablenull.public PointFrameAttachment createPointAttachment(Point pnt)
PointAttachablepnt
to this component. It should not be assumed that pnt
is currently connected to the component hierarchy, and no attempt
should be made to connect the returned attachment to the hierarchy;
the latter, if desired, is the responsibility of the caller.
In some cases, it may not be possible to attach the point at its present location. In that case, the method will create an attachment to the nearest feasible location.
createPointAttachment in interface PointAttachablepnt - point for which an attachment should be createdpnt to this componentpublic FrameFrameAttachment createFrameAttachment(Frame frame, RigidTransform3d TFW)
FrameAttachableframe to this
component. Once attached the frame will follow the body around. The
initial pose of the frame is specified by TFW, which gives
its position and orientation in world coordinates. If TFW is
null, then the current pose of the frame is used. If
frame is null, then a virtual attachment is
created at the initial pose specified by
TFW. frame and TFW cannot both be
null.
In some cases, it may not be possible to attach the frame at the requested location. In that case, the method will relocate the frame to the nearest feasible attachment location.
createFrameAttachment in interface FrameAttachableframe - frame to be attachedTFW - transform from (initial) frame coordinates to world
coordinatesframe to this componentpublic int getVelStateSize()
getVelStateSize in interface DynamicComponentgetVelStateSize in interface MotionTargetComponentpublic int getPosStateSize()
getPosStateSize in interface DynamicComponentgetPosStateSize in interface MotionTargetComponentpublic boolean velocityLimitExceeded(double tlimit,
double rlimit)
velocityLimitExceeded in interface DynamicComponenttlimit - translational velocity limitrlimit - rotational velocity limitpublic boolean isDuplicatable()
CopyableComponenttrue if and only if CopyableComponent.getCopyReferences(java.util.List<artisynth.core.modelbase.ModelComponent>, artisynth.core.modelbase.ModelComponent) returns true.
This method is not currently used. It is intended to provide a faster
way of determining if a component can be duplicated, without having to
use CopyableComponent.getCopyReferences(java.util.List<artisynth.core.modelbase.ModelComponent>, artisynth.core.modelbase.ModelComponent) to build the list of copy references.
isDuplicatable in interface CopyableComponenttrue if this component can be duplicated.public boolean getCopyReferences(java.util.List<ModelComponent> refs, ModelComponent ancestor)
CopyableComponenttrue if and only if CopyableComponent.isDuplicatable() returns
true.getCopyReferences in interface CopyableComponentrefs - list to which references are appendedancestor - root node of the hierarchy from which references are to be excludedpublic void setContactConstraint(double[] buf,
double w,
Vector3d dir,
ContactPoint cpnt)
CollidableDynamicComponentn is the component's velocity state size, and the contact is
defined by a direction dir and a point cpnt.
The computed values should be scaled by a weighting factor
w.setContactConstraint in interface CollidableDynamicComponentbuf - returns the n values for the block matrixw - weighting factor by which the values should be scaleddir - contact direction (world coordinates)cpnt - contact pointpublic void addToPointVelocity(Vector3d vel, double w, ContactPoint cpnt)
CollidableDynamicComponentw,
and add it to vel.addToPointVelocity in interface CollidableDynamicComponentvel - accumulates contact point velocity (world coordinates)w - weighting factorcpnt - contact point