00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020 #ifndef _PLANEWITHFRUSTUM_H_
00021 #define _PLANEWITHFRUSTUM_H_
00022
00023 #include "fmatvec/fmatvec.h"
00024 #include "mbsim/contour.h"
00025
00026 namespace MBSim {
00027
00035 class PlaneWithFrustum : public RigidContour {
00036 public:
00045 PlaneWithFrustum(const std::string &name="") : RigidContour(name), rFrustumOnPlane(0), rFrustumOnTop(0), hFrustum(0), rho(0) {
00046 }
00047
00048 PlaneWithFrustum(const std::string &name, double rFrustumOnPlane_, double rFrustumOnTop_, double hFrustum_, double rho_) : RigidContour(name), rFrustumOnPlane(rFrustumOnPlane_), rFrustumOnTop(rFrustumOnTop_), hFrustum(hFrustum_), rho(rho_) {
00049 checkInput();
00050 }
00051
00052
00053 std::string getType() const { return "PlaneWithFrustum"; }
00054
00055
00056
00057 double getFrustumRadiusOnPlane() {return rFrustumOnPlane; }
00058 double getFrustumRadiusOnTop() {return rFrustumOnTop; }
00059 double getFrustumHeight() {return hFrustum; }
00060 double getRoundingRadius() {return rho; }
00061
00062
00063 #ifdef HAVE_OPENMBVCPPINTERFACE
00064 void enableOpenMBV(bool enable=true);
00065 #endif
00066
00067 virtual void initializeUsingXML(MBXMLUtils::TiXmlElement *element);
00068 virtual MBXMLUtils::TiXmlElement* writeXMLFile(MBXMLUtils::TiXmlNode *element);
00069
00070 private:
00071 double rFrustumOnPlane;
00072 double rFrustumOnTop;
00073 double hFrustum;
00074 double rho;
00075
00076 void checkInput() {
00077 assert(rFrustumOnTop<rFrustumOnPlane);
00078 assert(rFrustumOnTop>1e-6);
00079 assert(rho>1e-6);
00080 assert(rho<fabs(hFrustum));
00081 assert(rho<rFrustumOnTop);
00082 }
00083 };
00084 }
00085
00086 #endif