public class FrameState extends java.lang.Object implements ScalableUnits
Constructor and Description |
---|
FrameState() |
Modifier and Type | Method and Description |
---|---|
void |
addScaledVelocity(double s,
Twist v)
Adds a scaled velocity to this frame's existing velocity.
|
void |
addVelocity(Twist v)
Adds a velocity to this frame's existing velocity.
|
void |
adjustPose(Twist delx)
Adjusts the pose of this FrameState by an increment specified as a twist
delx.
|
void |
adjustPose(Twist vel,
double h)
Adjusts the pose of this FrameState by a velocity (in Frame coordinates)
applied over a time interval h.
|
boolean |
equals(ComponentState state) |
int |
get(VectorNd x,
int idx) |
AxisAngle |
getAxisAngle() |
int |
getBodyVel(double[] buf,
int idx,
Twist bodyVel) |
void |
getBodyVelocity(Twist v)
Gets the velocity of the frame in body coordinates.
|
int |
getPos(double[] buf,
int idx) |
RigidTransform3d |
getPose() |
void |
getPose(RigidTransform3d X) |
Point3d |
getPosition() |
Quaternion |
getRotation() |
int |
getVel(double[] buf,
int idx) |
Twist |
getVelocity()
Returns the velocity of the frame in world coordinates.
|
void |
getVelocity(Twist v)
Gets the velocity of the frame in world coordinates.
|
void |
rotDerivative(Quaternion qvel)
Computes the time derivative of qrot given the current value of w.
|
void |
scaleDistance(double s)
Scales all distance coordinates.
|
void |
scaleMass(double s)
Scales all mass units.
|
void |
set(FrameState state) |
int |
set(VectorNd x,
int idx) |
int |
setBodyVel(double[] buf,
int idx) |
void |
setBodyVelocity(Twist v)
Sets the velocity of the frame in body coordinates.
|
int |
setPos(double[] buf,
int idx) |
void |
setPose(RigidTransform3d X) |
void |
setPosition(Point3d p) |
void |
setRotation(Quaternion q) |
int |
setVel(double[] buf,
int idx) |
void |
setVelocity(Twist v)
Sets the velocity of the frame in world coordinates.
|
java.lang.String |
toString() |
java.lang.String |
toString(NumberFormat fmt) |
java.lang.String |
toString(java.lang.String fmtStr) |
void |
updatePose() |
public void set(FrameState state)
public int set(VectorNd x, int idx)
public int get(VectorNd x, int idx)
public void setPose(RigidTransform3d X)
public void adjustPose(Twist delx)
X = X dX
delx
- incremental displacementpublic void adjustPose(Twist vel, double h)
X = X vel h
vel
- velocity in frame coordinatesh
- time interval over which to apply the velocitypublic void updatePose()
public RigidTransform3d getPose()
public void getPose(RigidTransform3d X)
public Point3d getPosition()
public void setPosition(Point3d p)
public Quaternion getRotation()
public void setRotation(Quaternion q)
public void setVelocity(Twist v)
v
- spatial velocitypublic void addVelocity(Twist v)
v
- spatial velocity to addpublic void addScaledVelocity(double s, Twist v)
s
- scale factorv
- spatial velocity to addpublic Twist getVelocity()
public void getVelocity(Twist v)
v
- returns the spatial velocitypublic void getBodyVelocity(Twist v)
v
- returns the spatial velocitypublic void setBodyVelocity(Twist v)
v
- spatial velocitypublic void rotDerivative(Quaternion qvel)
qvel
- returns the derivative of qrotpublic int getPos(double[] buf, int idx)
public AxisAngle getAxisAngle()
public int getVel(double[] buf, int idx)
public int getBodyVel(double[] buf, int idx, Twist bodyVel)
public int setPos(double[] buf, int idx)
public int setVel(double[] buf, int idx)
public int setBodyVel(double[] buf, int idx)
public java.lang.String toString()
toString
in class java.lang.Object
public java.lang.String toString(NumberFormat fmt)
public java.lang.String toString(java.lang.String fmtStr)
public void scaleDistance(double s)
ScalableUnits
scaleDistance
in interface ScalableUnits
s
- scaling factorpublic void scaleMass(double s)
ScalableUnits
scaleMass
in interface ScalableUnits
s
- scaling factorpublic boolean equals(ComponentState state)