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 CLODBUSTER_HH
00028 #define CLODBUSTER_HH
00029
00030 #include "Model.hh"
00031
00032
00033 class Body;
00034 class HingeJoint;
00035 class Geom;
00036
00037
00038
00039 typedef struct gz_position gz_position_t;
00040
00041
00042 class ClodBuster : public Model
00043 {
00044
00045 public: ClodBuster( World *world );
00046 public: virtual ~ClodBuster();
00047
00048
00049 public: virtual int Load( WorldFile *file, WorldFileNode *node );
00050
00051
00052 public: virtual int Init( WorldFile *file, WorldFileNode *node );
00053
00054
00055 public: virtual int Fini();
00056
00057
00058 public: virtual void Update( double step );
00059
00060
00061 private: void UpdateOdometry( double step );
00062
00063
00064 private: int OdeLoad( WorldFile *file, WorldFileNode *node );
00065
00066
00067 private: int OdeInit( WorldFile *file, WorldFileNode *node );
00068
00069
00070 private: int OdeFini();
00071
00072
00073 private: int IfaceInit();
00074
00075
00076 private: int IfaceFini();
00077
00078
00079 private: void IfaceGetCmd();
00080
00081
00082 private: void IfacePutData();
00083
00084
00085 private: double wheelSep, wheelDiam;
00086
00087
00088 private: Body *body;
00089 private: Geom *bodyGeoms[4];
00090 private: Body *tires[4];
00091 private: Body *stubs[4];
00092 private: HingeJoint *wjoints[4];
00093 private: HingeJoint *sjoints[4];
00094
00095
00096 private: gz_position_t *iface;
00097
00098
00099 private: double wheelSpeed[2];
00100
00101
00102 private: double odomPose[3];
00103
00104 private: double encoders[2];
00105 private: bool raw_encoder_position;
00106 };
00107
00108 #endif