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 #ifndef PIONEER2AT_HH
00028 #define PIONEER2AT_HH
00029
00030 #include "Model.hh"
00031
00032
00033 class Body;
00034 class HingeJoint;
00035 class RayProximity;
00036
00037
00038 class Pioneer2AT : public Model
00039 {
00040
00041 public: Pioneer2AT( World *world );
00042 public: virtual ~Pioneer2AT();
00043
00044
00045 public: virtual int Load( WorldFile *file, WorldFileNode *node );
00046
00047
00048 public: virtual int Init( WorldFile *file, WorldFileNode *node );
00049
00050
00051 public: virtual int Fini();
00052
00053
00054 private: int OdeLoad( WorldFile *file, WorldFileNode *node );
00055
00056
00057 private: int LoadSonar( WorldFile *file, WorldFileNode *node );
00058
00059
00060 public: virtual void Update( double step );
00061
00062
00063 private: void UpdateOdometry( double step );
00064
00065
00066 private: void GetPositionCmd();
00067
00068
00069 private: void PutPositionData();
00070
00071
00072 private: void PutPowerData();
00073
00074
00075 private: void PutSonarData();
00076
00077
00078 private: double updatePeriod, updateTime;
00079
00080
00081 private: double wheelSep, wheelDiam;
00082
00083
00084 private: double sonarMaxRange;
00085 private: GzVector pos[16];
00086 private: double dir[16];
00087
00088
00089 private: Body *chassis;
00090 private: Body *wheels[4];
00091 private: HingeJoint *wheelJoints[4];
00092
00093
00094 private: RayProximity *sonarSensor;
00095
00096
00097 private: gz_position_t *position_iface;
00098 private: gz_power_t *power_iface;
00099 private: gz_sonar_t *sonar_iface;
00100
00101
00102 private: double wheelSpeed[2];
00103
00104
00105 private: double odomPose[3];
00106
00107
00108 private: double odomVel[3];
00109
00110
00111 private: double batteryLevel;
00112
00113
00114 private: double batteryCurve[2];
00115 };
00116
00117 #endif