AURobotServers
4
|
#include <upose.h>
Public Member Functions | |
void | addPose (double x, double y, double h) |
void | clear () |
virtual const char * | getDataType () |
UPose | getPose () |
UPose * | getpPose () |
UMatrix4 * | getpQ () |
UMatrix4 | getQ () |
UMatrix4 * | getQi () |
UMatrix4 * | makeQi () |
UPoseQ | operator= (UPoseQ source) |
void | printPose (char *prestring) |
void | setPose (UPose iPose) |
void | setPose (double x, double y, double h) |
void | setQ (UMatrix4 *mQ) |
UPoseQ () | |
UPoseQ (UPoseQ *source) | |
virtual | ~UPoseQ () |
Public Attributes | |
bool | QiValid |
Protected Attributes | |
double | d |
UPose | pose |
UMatrix4 | Q |
UMatrix4 | Qi |
This classholds 2 2D position and orientation and the position uncertainty related to this position, i.e. [x,y,h]. The uncertainty is in the covariance matrix form (3x3)
UPoseQ::UPoseQ | ( | ) |
Constructor
UPoseQ::UPoseQ | ( | UPoseQ * | source | ) |
Constructor as copy from other UPosRobQ
|
virtual |
Destructor
|
inline |
Add to position estimate. NB! this do not change the covariance matrix.
|
inline |
Set position and covariance to zero
|
inlinevirtual |
Get (end) type of this structure
|
inline |
Get estimated pose
Referenced by UMapObj::getPose().
|
inline |
Get pointer to pose
Referenced by UMapObj::getpPose().
|
inline |
Get (pointer to) covariance matrix .
|
inline |
Get covariance matrix copy.
|
inline |
Get pointer to inverse of covariance matric. If not valid, then calculated. If not possible then Qi.err == -1. and QiValid is set to false.
UMatrix4 * UPoseQ::makeQi | ( | ) |
Generate inverse of Q. and calculated determinant d. If this is possible, then QiValid is set true, if not then QiValid is set to false.
References UMatrix4::det().
|
inline |
Print pose in single line to console, with the provided prestring in front of data.
|
inline |
Set position of only. NB! this do not change the covariance matrix.
|
inline |
Set position of only. NB! this do not change the covariance matrix.
|
inline |
Set covariance matrix - and invalidate the inverse version
References UMatrix::init().
|
protected |
Determinant of Q, but only valid if QiValid is true.
|
protected |
Save this qualified pose to html-like file. Return true is saved. Load a poseQ from this xml-class. Returns true if read. Reports format error to xml-class. Position in [x,y,h] coordiantes, where x if forward (or north), y is left (or west) and h is heading (or normal mathematic angle in an x,y coordinate system)
Referenced by operator=().
|
protected |
Covariance matrix related to this position
Referenced by operator=().
|
protected |
Inverse of the covariance matrix Q. But is only valid if QiValid is true.
Referenced by operator=().
bool UPoseQ::QiValid |
Referenced by operator=().