00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020 #ifndef _CARTESIAN_COORDINATES_OBSERVER_H__
00021 #define _CARTESIAN_COORDINATES_OBSERVER_H__
00022 #include "mbsim/observer.h"
00023 #ifdef HAVE_OPENMBVCPPINTERFACE
00024 #include <openmbvcppinterface/arrow.h>
00025
00026 namespace OpenMBV {
00027 class Frame;
00028 }
00029 #endif
00030
00031 namespace MBSim {
00032 class Frame;
00033
00034 class CartesianCoordinatesObserver : public Observer {
00035 private:
00036 Frame* frame;
00037 fmatvec::Vec3 ex, ey, ez;
00038 fmatvec::SqrMat3 A;
00039 #ifdef HAVE_OPENMBVCPPINTERFACE
00040 OpenMBV::Arrow *openMBVPosition,*openMBVXPosition, *openMBVYPosition, *openMBVZPosition, *openMBVVelocity, *openMBVXVelocity, *openMBVYVelocity, *openMBVZVelocity, *openMBVAcceleration, *openMBVXAcceleration, *openMBVYAcceleration, *openMBVZAcceleration;
00041 OpenMBV::Frame* openMBVFrame;
00042 #endif
00043
00044 public:
00045 CartesianCoordinatesObserver(const std::string &name);
00046 void setFrame(Frame *frame_) { frame = frame_; }
00047 void setOrientation(const fmatvec::SqrMat3 &A_) { A = A_; }
00048
00049 void init(InitStage stage);
00050 virtual void plot(double t, double dt);
00051
00052 #ifdef HAVE_OPENMBVCPPINTERFACE
00053 virtual void enableOpenMBVPosition(double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00054 virtual void enableOpenMBVVelocity(double scale=1, OpenMBV::Arrow::ReferencePoint refPoint=OpenMBV::Arrow::fromPoint, double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00055 virtual void enableOpenMBVAcceleration(double scale=1, OpenMBV::Arrow::ReferencePoint refPoint=OpenMBV::Arrow::fromPoint, double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00056 virtual void enableOpenMBVFrame(double size=1, double offset=1);
00057 #endif
00058
00059 };
00060
00061 }
00062
00063 #endif
00064