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
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048 #ifndef __PASSIVEMESH_H
00049 #define __PASSIVEMESH_H
00050
00051 #include <stdio.h>
00052 #include <math.h>
00053
00054 #include "primitive.h"
00055 #include "osgprimitive.h"
00056 #include "abstractobstacle.h"
00057
00058 namespace lpzrobots {
00059
00060
00061
00062
00063 class PassiveMesh : public AbstractObstacle{
00064 std::string filename;
00065 float scale;
00066 double mass;
00067
00068 Mesh* mesh;
00069 GlobalData globalData;
00070
00071
00072 public:
00073
00074
00075
00076
00077 PassiveMesh(const OdeHandle& odeHandle, const OsgHandle& osgHandle,const string& filename,
00078 GlobalData& globalData, double scale = 1.0, double mass = 1.0):
00079 AbstractObstacle::AbstractObstacle(odeHandle, osgHandle),
00080 filename(filename), scale(scale), mass(mass), globalData(globalData) {
00081 mesh=0;
00082 obstacle_exists=false;
00083 };
00084
00085 ~PassiveMesh(){
00086 if(mesh) delete mesh;
00087 }
00088
00089
00090
00091
00092 virtual void update(){
00093 if(mesh) mesh->update();
00094 };
00095
00096
00097
00098
00099
00100 virtual void setPose(const osg::Matrix& pose){
00101 this->pose = pose;
00102 if (obstacle_exists){
00103 destroy();
00104 }
00105 create();
00106 };
00107
00108
00109 virtual Primitive* getMainPrimitive() const { return mesh; }
00110
00111 protected:
00112
00113 bool drawBoundings;
00114
00115 virtual void create(){
00116 mesh = new Mesh(filename,scale,globalData);
00117 mesh->init(odeHandle, mass, osgHandle);
00118 osg::Vec3 pos=pose.getTrans();
00119 pos[2]+=mesh->getRadius();
00120 mesh->setPosition(pos);
00121 obstacle_exists=true;
00122 };
00123
00124
00125 virtual void destroy(){
00126 if(mesh) delete mesh;
00127 obstacle_exists=false;
00128 };
00129
00130 };
00131
00132 }
00133
00134 #endif