MBSim

Project Page
rigid_body_group_observer.h
00001 /* Copyright (C) 2004-2011 MBSim Development Team
00002  *
00003  * This library is free software; you can redistribute it and/or 
00004  * modify it under the terms of the GNU Lesser General Public 
00005  * License as published by the Free Software Foundation; either 
00006  * version 2.1 of the License, or (at your option) any later version. 
00007  *  
00008  * This library is distributed in the hope that it will be useful, 
00009  * but WITHOUT ANY WARRANTY; without even the implied warranty of 
00010  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU 
00011  * Lesser General Public License for more details. 
00012  *  
00013  * You should have received a copy of the GNU Lesser General Public 
00014  * License along with this library; if not, write to the Free Software 
00015  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
00016  *
00017  * Contact: martin.o.foerg@gmail.com
00018  */
00019 
00020 #ifndef _RIGID_BODY_GROUP_OBSERVER_H__
00021 #define _RIGID_BODY_GROUP_OBSERVER_H__
00022 #include "mbsim/observer.h"
00023 
00024 #ifdef HAVE_OPENMBVCPPINTERFACE
00025 #include <openmbvcppinterface/arrow.h>
00026 namespace OpenMBV {
00027   class Frame;
00028 }
00029 #endif
00030 
00031 namespace MBSim {
00032   class RigidBody;
00033   class Frame;
00034 
00035   class RigidBodyGroupObserver : public Observer {
00036     private:
00037       std::vector<RigidBody*> body;
00038       Frame* ref;
00039 #ifdef HAVE_OPENMBVCPPINTERFACE
00040       OpenMBV::Arrow *openMBVPosition, *openMBVVelocity, *openMBVAcceleration, *openMBVAngularVelocity, *openMBVAngularAcceleration, *openMBVWeight, *openMBVMomentum, *openMBVAngularMomentum, *openMBVDerivativeOfMomentum, *openMBVDerivativeOfAngularMomentum;
00041 #endif
00042 
00043     public:
00044       RigidBodyGroupObserver(const std::string &name);
00045       void addBody(RigidBody *body_) { body.push_back(body_); } 
00046       void setFrameOfReference(Frame* frame) { ref = frame; } 
00047 
00048       void init(InitStage stage);
00049       virtual void plot(double t, double dt);
00050 
00051 #ifdef HAVE_OPENMBVCPPINTERFACE
00052       void enableOpenMBVWeight(double scale=1, OpenMBV::Arrow::ReferencePoint refPoint=OpenMBV::Arrow::fromPoint, double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00053       void enableOpenMBVMomentum(double scale=1, OpenMBV::Arrow::ReferencePoint refPoint=OpenMBV::Arrow::fromPoint, double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00054       void enableOpenMBVAngularMomentum(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       void enableOpenMBVDerivativeOfMomentum(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       void enableOpenMBVDerivativeOfAngularMomentum(double scale=1, OpenMBV::Arrow::ReferencePoint refPoint=OpenMBV::Arrow::fromPoint, double diameter=0.5, double headDiameter=1, double headLength=1, double color=0.5);
00057 #endif
00058 
00059   };
00060 
00061 }  
00062 
00063 #endif
00064