00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021 #ifndef _CONTOUR_H_
00022 #define _CONTOUR_H_
00023
00024 #include "mbsim/element.h"
00025 #include "mbsim/contour_pdata.h"
00026 #include "mbsim/frame.h"
00027 #include "mbsim/mbsim_event.h"
00028
00029 #ifdef HAVE_OPENMBVCPPINTERFACE
00030 namespace OpenMBV {
00031 class RigidBody;
00032 }
00033 #endif
00034
00035 namespace MBSim {
00036
00037 class Object;
00038 class ContourPointData;
00039 class ContactKinematics;
00040
00051 class Contour : public Element {
00052 public:
00057 Contour(const std::string &name, Frame *R=0);
00058
00062 virtual ~Contour();
00063
00064
00065 virtual std::string getType() const { return "Contour"; }
00066 virtual void plot(double t, double dt = 1);
00067
00068
00069
00075 virtual void updateKinematicsForFrame(ContourPointData &cp, Frame::Feature ff) = 0;
00076
00082 virtual void updateJacobiansForFrame(ContourPointData &cp, int j=0) = 0;
00083
00088 virtual fmatvec::Vec3 computeNormal(ContourPointData &cp) { updateKinematicsForFrame(cp,Frame::normal); return cp.getFrameOfReference().getOrientation().col(0); }
00089
00094 virtual fmatvec::Vec3 computePosition(ContourPointData &cp) { updateKinematicsForFrame(cp,Frame::position); return cp.getFrameOfReference().getPosition(); }
00095
00100 virtual fmatvec::Vec3 computeVelocity(ContourPointData &cp) { updateKinematicsForFrame(cp,Frame::velocity); return cp.getFrameOfReference().getVelocity(); }
00101
00106 virtual fmatvec::Vec3 computeAngularVelocity(ContourPointData &cp) { updateKinematicsForFrame(cp,Frame::angularVelocity); return cp.getFrameOfReference().getAngularVelocity(); }
00107
00112 virtual double computeCurvature(ContourPointData &cp) { THROW_MBSIMERROR("(Contour::computeCurvature): Not implemented."); return 0; }
00113
00121 virtual fmatvec::Vec2 computeLagrangeParameter(const fmatvec::Vec3 &WrPoint) {THROW_MBSIMERROR("computeLagrangeParameter(const fmatvec::Vec3 &WrPoint): Not implemented for this contour: \"" + this->getType() + "\"."); return 0; }
00122
00126 virtual void setReferencePosition(const fmatvec::Vec3 &WrOP) { R->setPosition(WrOP); }
00127
00131 virtual void setReferenceOrientation(const fmatvec::SqrMat3 &AWC) { R->setOrientation(AWC); }
00132
00136 virtual void setReferenceVelocity(const fmatvec::Vec3 &WvP) { R->setVelocity(WvP); }
00137
00141 virtual void setReferenceAngularVelocity(const fmatvec::Vec3 &WomegaC) { R->setAngularVelocity(WomegaC); }
00142
00146 virtual void setReferenceJacobianOfTranslation(const fmatvec::Mat3xV &WJP, int j=0) { R->setJacobianOfTranslation(WJP,j); }
00147
00151 virtual void setReferenceGyroscopicAccelerationOfTranslation(const fmatvec::Vec3 &WjP, int j=0) { R->setGyroscopicAccelerationOfTranslation(WjP,j); }
00152
00156 virtual void setReferenceJacobianOfRotation(const fmatvec::Mat3xV &WJR, int j=0) { R->setJacobianOfRotation(WJR,j); }
00157
00161 virtual void setReferenceGyroscopicAccelerationOfRotation(const fmatvec::Vec3 &WjR, int j=0) { R->setGyroscopicAccelerationOfRotation(WjR,j); }
00162
00166 virtual void setReferenceAcceleration(const fmatvec::Vec3 &WaP) { R->setAcceleration(WaP); }
00167
00171 virtual void setReferenceAngularAcceleration(const fmatvec::Vec3 &WpsiC) { R->setAngularAcceleration(WpsiC); }
00172
00176 virtual void init(InitStage stage);
00177
00178
00184 virtual ContactKinematics * findContactPairingWith(std::string type0, std::string type1) = 0;
00185
00186
00187 Frame* getFrame() { return R; }
00188 Frame* getFrameOfReference() { return R; }
00189 const fmatvec::Vec3& getReferencePosition() const { return R->getPosition(); }
00190 const fmatvec::SqrMat3& getReferenceOrientation() const { return R->getOrientation(); }
00191 const fmatvec::Vec3& getReferenceVelocity() const { return R->getVelocity(); }
00192 const fmatvec::Vec3& getReferenceAngularVelocity() const { return R->getAngularVelocity(); }
00193 const fmatvec::Mat3xV& getReferenceJacobianOfTranslation(int j=0) const { return R->getJacobianOfTranslation(j); }
00194 const fmatvec::Mat3xV& getReferenceJacobianOfRotation(int j=0) const { return R->getJacobianOfRotation(j); }
00195 fmatvec::Mat3xV& getReferenceJacobianOfTranslation(int j=0) { return R->getJacobianOfTranslation(j); }
00196 fmatvec::Mat3xV& getReferenceJacobianOfRotation(int j=0) { return R->getJacobianOfRotation(j); }
00197 const fmatvec::Vec3& getReferenceGyroscopicAccelerationOfTranslation() const { return R->getGyroscopicAccelerationOfTranslation(); }
00198 const fmatvec::Vec3& getReferenceGyroscopicAccelerationOfRotation() const { return R->getGyroscopicAccelerationOfRotation(); }
00199 fmatvec::Vec3& getReferenceGyroscopicAccelerationOfTranslation() { return R->getGyroscopicAccelerationOfTranslation(); }
00200 fmatvec::Vec3& getReferenceGyroscopicAccelerationOfRotation() { return R->getGyroscopicAccelerationOfRotation(); }
00201
00202 virtual int gethSize(int i=0) const { return hSize[i]; }
00203 virtual int gethInd(int i=0) const { return hInd[i]; }
00204 virtual void sethSize(int size, int i=0) { hSize[i] = size; }
00205 virtual void sethInd(int ind, int i=0) { hInd[i] = ind; }
00206
00207
00208
00209
00210
00211
00212 void setFrameOfReference(Frame *frame) { R = frame; }
00213 void setFrameOfReference(const std::string &frame) { saved_frameOfReference = frame; }
00214
00215 virtual void updateStateDependentVariables(double t) {}
00216 virtual void updateJacobians(double t, int j=0) {}
00217 virtual void updateStateDerivativeDependentVariables(const fmatvec::Vec &ud, double t) {}
00218
00219 virtual void initializeUsingXML(xercesc::DOMElement *element);
00220 virtual xercesc::DOMElement* writeXMLFile(xercesc::DOMNode *element);
00221
00222 protected:
00223
00224
00225
00226
00227
00231 int hSize[2], hInd[2];
00232
00236 Frame *R;
00237
00238 std::string saved_frameOfReference;
00239 };
00240
00247 class RigidContour : public Contour {
00248 public:
00253 RigidContour(const std::string &name, Frame *R=0) : Contour(name,R)
00254 {}
00255
00256 virtual ~RigidContour();
00257
00258
00259 std::string getType() const { return "RigidContour"; }
00260 virtual void plot(double t, double dt = 1);
00261 virtual void init(InitStage stage);
00262
00263
00264
00265 virtual void updateKinematicsForFrame(ContourPointData &cp, Frame::Feature ff);
00266 virtual void updateJacobiansForFrame(ContourPointData &cp, int j=0);
00267
00268
00274 ContactKinematics * findContactPairingWith(std::string type0, std::string type1);
00275
00276 #ifdef HAVE_OPENMBVCPPINTERFACE
00277 boost::shared_ptr<OpenMBV::RigidBody>& getOpenMBVRigidBody() {
00278 return openMBVRigidBody;
00279 }
00280
00281 void setOpenMBVRigidBody(const boost::shared_ptr<OpenMBV::RigidBody> &ombvBody) {
00282 openMBVRigidBody = ombvBody;
00283 }
00284 #endif
00285
00286 protected:
00287 #ifdef HAVE_OPENMBVCPPINTERFACE
00288 boost::shared_ptr<OpenMBV::RigidBody> openMBVRigidBody;
00289 #endif
00290
00291 };
00292 }
00293
00294 #endif
00295