AURobotServers
4
|
#include <upose.h>
Public Member Functions | |
virtual void | clear () |
virtual const char * | getDataType () |
UPose | getPose () |
UPoseTime | getPoseTime () |
UPoseV | getPoseV () |
double | getVel () |
UPoseTVQ | operator+ (UPoseV pDelta) |
UPose | operator+ (UPoseTVQ pDelta) |
UPose | operator+ (UPoseTime pDelta) |
UPoseTVQ | operator+ (UPose pDelta) |
UPoseTVQ | operator- (UPoseV pRef) |
UPose | operator- (UPose pRef) |
UPose | operator- (UPoseTime pRef) |
UPose | operator- (UPoseTVQ pRef) |
virtual UPoseTVQ | operator= (UPose source) |
void | print (const char *prestring, char *buff, const int buffCnt) |
void | print (const char *prestring) |
void | set (double ix, double iy, double ih, UTime time, double iv, double qual) |
void | set (UPose pose, UTime time, double iv, double qual) |
void | set (UPoseTVQ *pose) |
void | set (UPoseTime *pose) |
void | set (UPoseV *pose) |
void | setVel (double velocity) |
virtual void | snprint (const char *preString, char *buff, const int buffCnt) |
UPoseTVQ () | |
UPoseTVQ (UPose pose, UTime t, double v, double q) | |
UPoseTVQ (double x, double y, double h, UTime t, double v, double q) | |
virtual | ~UPoseTVQ () |
Public Member Functions inherited from UPoseTime | |
virtual const char * | codeXml (char *buf, const int bufCnt, const char *extraAttr) |
void | fprint (FILE *fd, const char *preString) |
UPose | getPose () |
UPose | getPoseAtTime (UPoseTime otherPose, UTime atTime) |
UPoseTime | operator= (UPose source) |
UPoseTime | operator= (UPoseTVQ source) |
void | setPt (double ix, double iy, double ih, UTime it) |
void | setPt (UPose pose, UTime it) |
void | setPt (double ix, double iy, double ih, double it) |
UPoseTime () | |
UPoseTime (double ix, double iy, double ih, UTime it) | |
UPoseTime (UPose pose, UTime it) | |
virtual | ~UPoseTime () |
Public Member Functions inherited from UPose | |
void | add (double dist, double headingChange) |
void | add (double ix, double iy, double ih) |
UMatrix4 | asCol3 () |
UMatrix4 | asCol4 () |
UMatrix4 | asMatrix2x2MtoP () |
UMatrix4 | asMatrix2x2PtoM () |
UMatrix4 | asMatrix3x3MtoP () |
UMatrix4 | asMatrix3x3PtoM () |
UMatrix4 | asMatrix4x4MtoP () |
UMatrix4 | asMatrix4x4PtoM () |
UMatrix4 | asMatrix4x4PtoMPos () |
UMatrix4 | asRow3 () |
UMatrix4 | asRow4 () |
virtual const char * | codeXml (const char *name, char *buf, const int bufCnt, const char *extraAttr) |
void | fprint (FILE *fd, const char *prestring) |
char * | getAsSml (const char *name, char *buff, int buffCnt) |
double | getDistance (UPose other) |
double | getDistance (UPose *other) |
double | getDistance (UPosition other) |
double | getDistance (UPosition *other) |
double | getDistToPoseLine (const double Px, const double Py) |
double | getDistToPoseLineSigned (const double Px, const double Py) |
double | getHeadingDeg () |
double | getHeadingDiff (UPose other) |
double | getHeadingRad () |
UPosition | getMapToPose (UPosition mapPos) |
U2Dpos | getMapToPose (U2Dpos mapPos) |
UPosition | getMapToPose (UPose *mapPos) |
UPosition | getMapToPose (UPose mapPos) |
CvPoint | getMapToPose (CvPoint mapPos) |
UPose | getMapToPosePose (UPose *mapPose) |
UPose | getMapToPosePose (UPose mapPose) |
UPosition | getPos (double z=0.0) |
UPosition | getPoseToMap (UPosition posePos) |
U2Dpos | getPoseToMap (U2Dpos posePos) |
UPosition | getPoseToMap (double localX, double localY) |
UPosition | getPoseToMap (UPose posePos) |
CvPoint | getPoseToMap (CvPoint mapPos) |
UPose | getPoseToMapPose (UPose poseLocal) |
UPose | getPoseToMapPose (double x, double y, double h) |
UPose | neg () |
UPose | operator+ (UPose pDelta) |
UPose | operator+ (UPoseV pDelta) |
UPose | operator+ (UPoseTime pDelta) |
UPose | operator+ (UPoseTVQ pDelta) |
UPose | operator- (UPose pRef) |
UPose | operator- (UPoseV pRef) |
UPose | operator- (UPoseTime pRef) |
UPose | operator- (UPoseTVQ pRef) |
UPose | operator= (UPoseTime source) |
UPose | operator= (UPoseV source) |
UPose | operator= (UPoseTVQ source) |
UPose | operator= (UMatrix4 mat) |
void | print (char *buf, const char *prestring, int bufLng) |
void | print (const char *str) |
void | set (UPosition *pos, URotation *rot) |
void | set (double ix, double iy, double ih) |
UPose | set (UMatrix *mat) |
UPose () | |
UPose (double x, double y, double h) | |
UPose (UPose *source) | |
UPose (UPosition *pos, URotation *rot) | |
virtual | ~UPose () |
Public Member Functions inherited from UDataBase | |
bool | isA (const char *typeString) |
virtual bool | isAlsoA (const char *typeString) |
UDataBase () | |
virtual | ~UDataBase () |
Public Attributes | |
double | q |
double | vel |
Public Attributes inherited from UPoseTime | |
UTime | t |
Public Attributes inherited from UPose | |
double | h |
double | x |
double | y |
Additional Inherited Members | |
Protected Member Functions inherited from UPose | |
UPose | addCed (UPose D) |
UPose | addCed (UPose *D) |
void | addDeltaPose (UPose D) |
void | asAddC (UPose Vbase, UPose D) |
void | asNegC (UPose D) |
void | asSubC (UPose Va, UPose Vbase) |
void | subC (UPose *Vbase) |
UPose | subCed (UPose Vbase) |
UPose | subCed (UPose *Vbase) |
Class to pose information and time of pose information
UPoseTVQ::UPoseTVQ | ( | ) |
Constructor
References q.
UPoseTVQ::UPoseTVQ | ( | double | x, |
double | y, | ||
double | h, | ||
UTime | t, | ||
double | v, | ||
double | q | ||
) |
|
inlinevirtual |
Destructor
|
inlinevirtual |
Clear to zero.
Reimplemented from UPoseTime.
References UTime::clear(), and UPose::operator-().
Referenced by UResPoseHist::UResPoseHist().
|
inlinevirtual |
Get (end) type of this structure
Reimplemented from UPoseTime.
|
inline |
Get the UPose part only
Referenced by ULaserDevice::getFakeScan(), UFunctionPoseHist::handlePoseHistCommand(), UResLocater::set_utmstate(), UResPoseHist::setPoseResult(), updateDisplacement(), and UFuncLoca2::updateDisplacement().
|
inline |
Get the UPose part only
Referenced by UResPoseHist::getNewest(), UResLocater::set_utmstate(), and UResPoseHist::setPoseResult().
UPoseV UPoseTVQ::getPoseV | ( | ) |
|
inline |
Get velocity
Referenced by snprint().
Add a delta pose to a base pose to get a new pose. The delta pose must be in base pose perspective. i.e. To get from a reference position P1 to a new position P2 after a movement of 'pDelta'
References UPose::addCed(), UPoseV::getVel(), setVel(), and vel.
References UPose::addCed().
References UPose::addCed().
Assign from base pose Assign from base pose Assign from base pose Add a delta pose to a base pose to get a new pose. The delta pose must be in base pose perspective. i.e. To get from a reference position P1 to a new position P2 after a movement of 'pDelta'
References UPose::addCed().
Subtract 2 poses to get a delta pose from ref to base. i.e. if P1 and P2 is two poses, and deltaPose Pd = P2 - P1, then P2 is at position Pd in local P1 coordinates, and P2 = P1 + Pd
References UPoseV::getVel(), setVel(), UPose::subCed(), and vel.
References UPose::subCed().
References UPose::subCed().
References UPose::operator+(), and UPose::subCed().
Assign from base pose
References UPose::h, UPose::operator+(), UPose::x, and UPose::y.
|
inline |
Print tatus to string. Deprecated call format - use snprint(...)
References UPose::snprint().
Referenced by ULaserDevice::getFakeScan().
|
inline |
Print tatus to console
References UPose::snprint().
|
inline |
Set all variables from doubles
Referenced by UResSmrIf::eventPoseUpdated(), ULaserData::getFakePoseTime(), UResLocater::locate(), UResLocater::set_state(), UResLocater::set_utmstate(), and UResGps::updateVars().
Set all variables from pose and velocity
|
inline |
Set all variables from other pose
|
inline |
Set all variables from other pose
void UPoseTVQ::set | ( | UPoseV * | pose | ) |
|
inline |
Set velocity
Referenced by operator+(), and operator-().
|
virtual |
Print status for this structure
Reimplemented from UPoseTime.
References UPose::getHeadingDeg(), UTime::getMicrosec(), UTime::getSec(), getVel(), UPose::h, q, UPoseTime::t, UPose::x, and UPose::y.
double UPoseTVQ::q |
Pose quality - this may be dependent on use, but basically a double value associated with pose
Referenced by UResPoseHist::addPoseHist(), ULaserMeasurement::clear(), UResSmrIf::eventGpsUpdate(), UFakeMap::fakeAdvancePose(), ULaserData::getFakePoseTime(), UResPoseHist::getPoseAtTime(), USmlTag::getPoseTVQ(), UResIfVar::handlePoseHist(), UFunctionPoseHist::handlePoseHistCommand(), UFunctionPoseHist::listPoses(), UResPoseHist::methodCall(), UNavPaint::paintOdoDataText(), UNavView::paintOdoDataText(), UResPoseHist::replayStep(), set(), UResLocater::set_utmstate(), UResLocater::setUtmPoseToMapPose(), snprint(), UFuncLoca2::updateStatus(), UFuncLocalize::updateStatus(), UResPoseHist::updateVarPool(), and UPoseTVQ().
double UPoseTVQ::vel |
Actual velocity. velocity may be negative for reverse speed.
Referenced by UResPoseHist::addIfNeeded(), UResPoseHist::addPoseHist(), ULaserMeasurement::clear(), UResSmrIf::eventGpsUpdate(), UFakeMap::fakeAdvanceControl(), UResPoseHist::getNewest(), UResPoseHist::getPoseAtTime(), USmlTag::getPoseTVQ(), getPoseV(), UResIfVar::handlePoseHist(), UFunctionPoseHist::handlePoseHistCommand(), UFunctionLaser::handleScanGetCommand(), UFunctionPoseHist::listPoses(), UResPoseHist::methodCall(), operator+(), operator-(), UNavPaint::paintOdoDataText(), UNavView::paintOdoDataText(), UResPoseHist::replayStep(), set(), UResLocater::set_utmstate(), UResLocater::setUtmPoseToMapPose(), UResPoseHist::updateVarPool(), and UPoseTVQ().