Grip-Reloaded
Grip version visualizaiton interface for DART (DynamicAnimationandRoboticsToolkits)
|
00001 /* 00002 * Copyright (c) 2014, Georgia Tech Research Corporation 00003 * All rights reserved. 00004 * 00005 * Author: Pete Vieira <pete.vieira@gatech.edu> 00006 * Date: Feb 2014 00007 * 00008 * Humanoid skeletonics Lab Georgia Institute of Technology 00009 * Director: Mike Stilman http://www.golems.org 00010 * 00011 * 00012 * This file is provided under the following "BSD-style" License: 00013 * Redistribution and use in source and binary forms, with or 00014 * without modification, are permitted provided that the following 00015 * conditions are met: 00016 * 00017 * * Redistributions of source code must retain the above copyright 00018 * notice, this list of conditions and the following disclaimer. 00019 * 00020 * * Redistributions in binary form must reproduce the above 00021 * copyright notice, this list of conditions and the following 00022 * disclaimer in the documentation and/or other materials provided 00023 * with the distribution. 00024 * 00025 * * Neither the name of the Humanoid Robotics Lab nor the names of 00026 * its contributors may be used to endorse or promote products 00027 * derived from this software without specific prior written 00028 * permission 00029 * 00030 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND 00031 * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, 00032 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 00033 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 00034 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR 00035 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 00036 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 00037 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 00038 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 00039 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00040 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 00041 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00042 * POSSIBILITY OF SUCH DAMAGE. 00043 */ 00044 00053 #ifndef WORLD_VISUALS_H 00054 #define WORLD_VISUALS_H 00055 00056 // Local includes 00057 #include "../osgGolems/Line.h" 00058 00059 // OpenSceneGraph includes 00060 #include <osg/MatrixTransform> 00061 00062 // Eigen includes 00063 #include <Eigen/Core> 00064 #include <Eigen/Dense> 00065 00066 namespace osgDart { 00067 00072 class ContactForceVisual : public osg::MatrixTransform 00073 { 00074 public: 00079 ContactForceVisual(bool debug=false); 00080 00084 ~ContactForceVisual(); 00085 00093 void createForceVector(float lineLength, 00094 const Eigen::Vector3d &contactPoint, 00095 const Eigen::Vector3d &contactForce); 00096 00104 void update(float lineLength, const Eigen::Vector3d &contactPoint, 00105 const Eigen::Vector3d &contactForce); 00106 00107 protected: 00115 osg::Matrix _convertVectorToOsgTF(const Eigen::Vector3d &point, const Eigen::Vector3d &vector); 00116 00118 osgGolems::Line* _contactForceLine; 00119 00121 bool _debug; 00122 00123 }; // end class ContactForceVisual 00124 00125 } // end namespace osgDart 00126 00127 #endif // WORLD_VISUALS_H