Menu
▾
▴
[Gearbox-commit] SF.net SVN: gearbox: [197] gearbox/trunk/submitted/gbxnovatelacfr
|
From: <rum...@us...> - 2008-06-19 15:07:01
|
Revision: 197
http://gearbox.svn.sourceforge.net/gearbox/?rev=197&view=rev
Author: rumataxyz
Date: 2008-06-19 08:07:00 -0700 (Thu, 19 Jun 2008)
Log Message:
-----------
added implementations of toString() to the various data-types
Modified Paths:
--------------
gearbox/trunk/submitted/gbxnovatelacfr/driver.cpp
gearbox/trunk/submitted/gbxnovatelacfr/driver.h
Modified: gearbox/trunk/submitted/gbxnovatelacfr/driver.cpp
===================================================================
--- gearbox/trunk/submitted/gbxnovatelacfr/driver.cpp 2008-06-19 14:20:38 UTC (rev 196)
+++ gearbox/trunk/submitted/gbxnovatelacfr/driver.cpp 2008-06-19 15:07:00 UTC (rev 197)
@@ -54,6 +54,7 @@
// these guys are used to directly decode messages;
// obviously fails on endian mismatch, any sort of size mismatch and is rather nasty in general;
// feel free to implement something better
+ // TODO: at least at runtime checking
gnua::BestGpsPosLogB bestGpsPos;
gnua::BestGpsVelLogB bestGpsVel;
gnua::InsPvaLogSB insPva;
@@ -66,6 +67,8 @@
std::auto_ptr<gna::GenericData> createExternalMsg(gnua::BestGpsVelLogB &bestGpsVel, struct timeval &timeStamp);
std::auto_ptr<gna::GenericData> createExternalMsg(gnua::RawImuLogSB &rawImu, struct timeval &timeStamp, gnua::ImuDecoder *imuDecoder);
+ //helper functions for the toString() gear
+ std::string statusToString(gna::StatusMessagetype statusMessageType, std::string statusMessage);
std::string doubleVectorToString(vector<double > &vec, std::string seperator = std::string(" "));
}
@@ -663,6 +666,89 @@
return ss.str();
}
+std::string
+InsPvaData::toString(){
+ std::stringstream ss;
+ ss << "timeStampSec " << timeStampSec << " ";
+ ss << "timeStampUSec " << timeStampUSec << " ";
+ ss << "gpsWeekNr " << gpsWeekNr << " ";
+ ss << "secIntoWeek " << secIntoWeek << " ";
+ ss << "latitude " << latitude << " ";
+ ss << "longitude " << longitude << " ";
+ ss << "height " << height << " ";
+ ss << "northVelocity " << northVelocity << " ";
+ ss << "eastVelocity " << eastVelocity << " ";
+ ss << "upVelocity " << upVelocity << " ";
+ ss << "roll " << roll << " ";
+ ss << "pitch " << pitch << " ";
+ ss << "azimuth " << azimuth << " ";
+ ss << statusToString(statusMessageType, statusMessage);
+ return ss.str();
+};
+
+std::string
+BestGpsPosData::toString(){
+ std::stringstream ss;
+ ss << "timeStampSec " << timeStampSec << " ";
+ ss << "timeStampUSec " << timeStampUSec << " ";
+ ss << "gpsWeekNr " << gpsWeekNr << " ";
+ ss << "msIntoWeek " << msIntoWeek << " ";
+ ss << "solutionStatus " << solutionStatus << " ";
+ ss << "positionType " << positionType << " ";
+ ss << "latitude " << latitude << " ";
+ ss << "longitude " << longitude << " ";
+ ss << "heightAMSL " << heightAMSL << " ";
+ ss << "undulation " << undulation << " ";
+ ss << "datumId " << datumId << " ";
+ ss << "sigmaLatitude " << sigmaLatitude << " ";
+ ss << "sigmaLongitude " << sigmaLongitude << " ";
+ ss << "sigmaHeight " << sigmaHeight << " ";
+ ss << "baseStationId[4] " << baseStationId[4] << " ";
+ ss << "diffAge " << diffAge << " ";
+ ss << "solutionAge " << solutionAge << " ";
+ ss << "numObservations " << numObservations << " ";
+ ss << "numL1Ranges " << numL1Ranges << " ";
+ ss << "numL1RangesRTK " << numL1RangesRTK << " ";
+ ss << "numL2RangesRTK " << numL2RangesRTK << " ";
+ ss << statusToString(statusMessageType, statusMessage);
+ return ss.str();
+};
+
+std::string
+ BestGpsVelData::toString(){
+ std::stringstream ss;
+ ss << "timeStampSec " << timeStampSec << " ";
+ ss << "timeStampUSec " << timeStampUSec << " ";
+ ss << "gpsWeekNr " << gpsWeekNr << " ";
+ ss << "msIntoWeek " << msIntoWeek << " ";
+ ss << "solutionStatus " << solutionStatus << " ";
+ ss << "positionType " << positionType << " ";
+ ss << "latency " << latency << " ";
+ ss << "diffAge " << diffAge << " ";
+ ss << "horizontalSpeed " << horizontalSpeed << " ";
+ ss << "trackOverGround " << trackOverGround << " ";
+ ss << "verticalSpeed " << verticalSpeed << " ";
+ ss << statusToString(statusMessageType, statusMessage);
+ return ss.str();
+};
+
+std::string
+RawImuData::toString(){
+ std::stringstream ss;
+ ss << "timeStampSec " << timeStampSec << " ";
+ ss << "timeStampUSec " << timeStampUSec << " ";
+ ss << "gpsWeekNr " << gpsWeekNr << " ";
+ ss << "secIntoWeek " << secIntoWeek << " ";
+ ss << "zDeltaV " << zDeltaV << " ";
+ ss << "yDeltaV " << yDeltaV << " ";
+ ss << "xDeltaV " << xDeltaV << " ";
+ ss << "zDeltaAng " << zDeltaAng << " ";
+ ss << "yDeltaAng " << yDeltaAng << " ";
+ ss << "xDeltaAng " << xDeltaAng << " ";
+ ss << statusToString(statusMessageType, statusMessage);
+ return ss.str();
+};
+
} //namespace
namespace{
@@ -984,4 +1070,29 @@
}
return ss.str();
}
+
+ std::string statusToString(gna::StatusMessagetype statusMessageType, std::string statusMessage){
+ std::stringstream ss;
+ switch(statusMessageType){
+ case gna::NoMsg:
+ ss << "NoMsg" << " ";
+ break;
+ case gna::Initialising:
+ ss << "Initialising" << " ";
+ break;
+ case gna::Ok:
+ ss << "Ok" << " ";
+ break;
+ case gna::Warning:
+ ss << "Warning" << " ";
+ break;
+ case gna::Fault:
+ ss << "Fault" << " ";
+ break;
+ default:
+ ss << "UnknownStatus" << " ";
+ }
+ ss << statusMessage;
+ return ss.str();
+ }
}//namespace
Modified: gearbox/trunk/submitted/gbxnovatelacfr/driver.h
===================================================================
--- gearbox/trunk/submitted/gbxnovatelacfr/driver.h 2008-06-19 14:20:38 UTC (rev 196)
+++ gearbox/trunk/submitted/gbxnovatelacfr/driver.h 2008-06-19 15:07:00 UTC (rev 197)
@@ -274,7 +274,7 @@
public:
virtual ~GenericData(){};
virtual DataType type() const=0;
- virtual std::string toString() const=0;
+ virtual std::string toString()=0;
private:
};
@@ -284,9 +284,7 @@
DataType type() const {
return InsPva;
}
- std::string toString() const{
- return "implement me!";
- }
+ std::string toString();
int gpsWeekNr; //
double secIntoWeek; //
double latitude; //!< [deg] north positive WGS84
@@ -326,9 +324,7 @@
DataType type() const {
return BestGpsPos;
}
- std::string toString() const{
- return "implement me!";
- }
+ std::string toString();
int gpsWeekNr; //
unsigned int msIntoWeek; //!< milliseconds from beginning of week
GpsSolutionStatusType solutionStatus; //
@@ -362,9 +358,7 @@
DataType type() const {
return BestGpsVel;
}
- std::string toString() const{
- return "implement me!";
- }
+ std::string toString();
int gpsWeekNr; //
unsigned int msIntoWeek; //!< milliseconds from beginning of week
GpsSolutionStatusType solutionStatus; //
@@ -388,9 +382,7 @@
DataType type() const {
return RawImu;
}
- std::string toString() const{
- return "implement me!";
- }
+ std::string toString();
int gpsWeekNr;
double secIntoWeek;
//!@name Change in speed
This was sent by the SourceForge.net collaborative development platform, the world's largest Open Source development site.
|