public class SystemPositionAndAttitude extends java.lang.Object implements java.lang.Cloneable, java.lang.Comparable<SystemPositionAndAttitude>, java.io.Serializable
Constructor and Description |
---|
SystemPositionAndAttitude()
Empty constructor
|
SystemPositionAndAttitude(pt.lsts.imc.EstimatedState state) |
SystemPositionAndAttitude(LocationType position,
double roll,
double pitch,
double yaw)
Creates a new VehicleState from the given position and axis attitudes
|
SystemPositionAndAttitude(SystemPositionAndAttitude vs) |
Modifier and Type | Method and Description |
---|---|
void |
addNEDOffsets(double n,
double e,
double d) |
SystemPositionAndAttitude |
clone()
Creates a new cloned SystemPositionAndAttitudeState
|
int |
compareTo(SystemPositionAndAttitude o) |
double |
getAltitude() |
double |
getDepth() |
double[] |
getNEDPosition()
Returns the offset from absolute 0 as double[3]:
0 - The offset (in the North direction) from absolut (0,0,0)
1 - The offset (in the East direction) from absolut (0,0,0)
2 - The offset (in the Down direction) from absolut (0,0,0)
|
double |
getP() |
double |
getPitch() |
LocationType |
getPosition() |
pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension |
getPqr() |
double |
getQ() |
double |
getR() |
double |
getRoll() |
long |
getTime() |
double |
getU() |
pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension |
getUvw() |
double |
getV() |
double |
getVx() |
pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension |
getVxyz() |
double |
getVy() |
double |
getVz() |
double |
getW() |
double |
getYaw() |
void |
moveForward(double meters)
This function changes the current state by moving the vehicle forward If the value of meters is negative, the
vehicle will actually move back
|
void |
moveUp(float meters)
This function changes the current state by moving the vehicle up If the value of meters is negative, the vehicle
will actually move down
|
void |
rotateXY(double radians)
This function changes this state by rotating the vehicle according to the angle given This rotation will be done
only in the horizontal plane (x,y)
|
void |
setAltitude(double altitude) |
void |
setDepth(double depth) |
void |
setP(double p) |
void |
setPitch(double pitch) |
void |
setPosition(LocationType position) |
void |
setPQR(double p,
double q,
double r) |
void |
setPqr(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension pqr) |
void |
setQ(double q) |
void |
setR(double r) |
void |
setRoll(double roll) |
void |
setTime(long time) |
void |
setU(double u) |
void |
setUVW(double u,
double v,
double w) |
void |
setUvw(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension uvw) |
void |
setV(double v) |
void |
setVxyz(double vx,
double vy,
double vz) |
void |
setVxyz(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension vxyz) |
void |
setW(double w) |
void |
setYaw(double yaw) |
pt.lsts.imc.EstimatedState |
toEstimatedState() |
java.lang.String |
toString() |
public SystemPositionAndAttitude()
public SystemPositionAndAttitude(LocationType position, double roll, double pitch, double yaw)
position
- The vehicle positionroll
- The vehicle rotation over the X (South->North) axis (radians)pitch
- The vehicle rotation over the Y (West->East) axis (radians)yaw
- The vehicle rotation over the Z (Down->Up) axis (radians)public SystemPositionAndAttitude(SystemPositionAndAttitude vs)
public SystemPositionAndAttitude(pt.lsts.imc.EstimatedState state)
public pt.lsts.imc.EstimatedState toEstimatedState()
public void rotateXY(double radians)
radians
- The rotation anglepublic void addNEDOffsets(double n, double e, double d)
public void moveForward(double meters)
meters
- The number of meters to advance or go back (if negative)public void moveUp(float meters)
meters
- The number of meters to move up or down (if negative)public SystemPositionAndAttitude clone()
clone
in class java.lang.Object
public double[] getNEDPosition()
- 0 - The offset (in the North direction) from absolut (0,0,0)
- 1 - The offset (in the East direction) from absolut (0,0,0)
- 2 - The offset (in the Down direction) from absolut (0,0,0)
public double getPitch()
public void setPitch(double pitch)
public LocationType getPosition()
public void setPosition(LocationType position)
public double getAltitude()
public void setAltitude(double altitude)
public double getDepth()
public void setDepth(double depth)
depth
- the depth to setpublic double getRoll()
public void setRoll(double roll)
public double getYaw()
public void setYaw(double yaw)
public java.lang.String toString()
toString
in class java.lang.Object
public double getP()
public void setP(double p)
public double getQ()
public void setQ(double q)
public double getR()
public void setR(double r)
public double getU()
public void setU(double u)
public double getV()
public void setV(double v)
public double getW()
public void setW(double w)
public void setUVW(double u, double v, double w)
public void setPQR(double p, double q, double r)
public pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension getPqr()
public void setPqr(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension pqr)
public pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension getUvw()
public void setUvw(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension uvw)
public pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension getVxyz()
public void setVxyz(pt.lsts.neptus.mp.SystemPositionAndAttitude.Vector3Dimension vxyz)
public void setVxyz(double vx, double vy, double vz)
public double getVx()
public double getVy()
public double getVz()
public long getTime()
public void setTime(long time)
time
- the time to setpublic int compareTo(SystemPositionAndAttitude o)
compareTo
in interface java.lang.Comparable<SystemPositionAndAttitude>
Copyright © 2004-2020 FEUP-LSTS and Neptus developers. All Rights Reserved.