GistSal_Grapher.H
00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037 #ifndef GistSal_Grapher_H
00038 #define GistSal_Grapher_H
00039
00040 #include "Component/ModelComponent.H"
00041 #include "Component/ModelParam.H"
00042
00043 #include "Robots/RobotBrain/RobotBrainComponent.H"
00044 #include "Util/Timer.H"
00045
00046 #include "Transport/FrameInfo.H"
00047 #include "Raster/GenericFrame.H"
00048 #include "Image/Image.H"
00049 #include "Image/DrawOps.H"
00050 #include "Image/Point3D.H"
00051 #include "GUI/XWinManaged.H"
00052 #include "GUI/ImageDisplayStream.H"
00053
00054 #include "Ice/RobotBrainObjects.ice.H"
00055 #include "Ice/RobotSimEvents.ice.H"
00056 #include "Ice/BeobotEvents.ice.H"
00057 #include <IceUtil/Thread.h>
00058
00059 #include <vector>
00060 typedef struct{
00061 float time,transVel,rotVel,encoderX,encoderY,encoderOri,rcTransVel,rcRotVel;
00062 int rcMode;
00063 } motorData;
00064 typedef struct{
00065 float time;
00066 std::string imagePath ;
00067 } imageData;
00068
00069 typedef struct{
00070 float time;
00071 int segNum ;
00072 float lenTrav;
00073 } locData;
00074 typedef struct{
00075 float time;
00076 float lrfMin;
00077 float lrfMax;
00078 } lrfData;
00079 class GistSal_Grapher : public RobotBrainComponent
00080 {
00081 public:
00082
00083 GistSal_Grapher(OptionManager& mgr,
00084 const std::string& descrName = "GistSal_Grapher",
00085 const std::string& tagName = "GistSal_Grapher");
00086
00087 ~GistSal_Grapher();
00088
00089 virtual void evolve();
00090
00091
00092 virtual void updateMessage
00093 (const RobotSimEvents::EventMessagePtr& eMsg,
00094 const Ice::Current&);
00095
00096 virtual void registerTopics();
00097
00098 bool initLogFile();
00099
00100 void start1();
00101
00102 private:
00103 void writeToLogFile(std::string line);
00104 void searchLogFile();
00105 void updateGUI();
00106
00107 std::string itsLogFilename;
00108 IceUtil::Mutex its_logFilename_mutex;
00109
00110
00111
00112 Timer itsTimer;
00113 Image<PixRGB<byte> > itsDispImage;
00114 XWinManaged itsXwin;
00115 std::string itsStartTime;
00116 std::string itsLogFoldername;
00117 int itsCurrMessageID;
00118 std::vector<motorData> itsLogMotorData;
00119 std::vector<locData> itsLogLocData;
00120 std::vector<lrfData> itsLogLrfData;
00121 std::vector<float> itsLogSegData;
00122 };
00123
00124 #endif
00125
00126
00127
00128
00129
00130
00131