MobilizedBody_Custom.h

Go to the documentation of this file.

#ifndef SimTK_SIMBODY_MOBILIZED_BODY_CUSTOM_H_
#define SimTK_SIMBODY_MOBILIZED_BODY_CUSTOM_H_
 
/* -------------------------------------------------------------------------- *
 *                               Simbody(tm)                                  *
 * -------------------------------------------------------------------------- *
 * This is part of the SimTK biosimulation toolkit originating from           *
 * Simbios, the NIH National Center for Physics-Based Simulation of           *
 * Biological Structures at Stanford, funded under the NIH Roadmap for        *
 * Medical Research, grant U54 GM072970. See https://simtk.org/home/simbody.  *
 *                                                                            *
 * Portions copyright (c) 2008-13 Stanford University and the Authors.        *
 * Authors: Peter Eastman, Michael Sherman                                    *
 * Contributors:                                                              *
 *                                                                            *
 * Licensed under the Apache License, Version 2.0 (the "License"); you may    *
 * not use this file except in compliance with the License. You may obtain a  *
 * copy of the License at http://www.apache.org/licenses/LICENSE-2.0.         *
 *                                                                            *
 * Unless required by applicable law or agreed to in writing, software        *
 * distributed under the License is distributed on an "AS IS" BASIS,          *
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.   *
 * See the License for the specific language governing permissions and        *
 * limitations under the License.                                             *
 * -------------------------------------------------------------------------- */
 
#include "simbody/internal/MobilizedBody.h"
 
namespace SimTK {
 
//==============================================================================
//                        MOBILIZED BODY :: CUSTOM  
//==============================================================================
class SimTK_SIMBODY_EXPORT MobilizedBody::Custom : public MobilizedBody {
public:
    class Implementation;
    class ImplementationImpl;
 
    Custom() {}
 
    Custom(MobilizedBody& parent, Implementation* implementation, 
           const Transform& X_PF, const Body& bodyInfo, const Transform& X_BM,
           Direction direction=Forward);
    
    Custom(MobilizedBody& parent, Implementation* implementation, 
           const Body& bodyInfo, Direction direction=Forward);
 // hide from Doxygen
    SimTK_INSERT_DERIVED_HANDLE_DECLARATIONS(Custom, CustomImpl, MobilizedBody);
protected:
    const Implementation& getImplementation() const;
    Implementation&       updImplementation();
 
};
 
// We only want the template instantiation to occur once. This symbol is 
// defined in the Simbody compilation unit that defines the MobilizedBody class
// but should not be defined any other time.
#ifndef SimTK_SIMBODY_DEFINING_MOBILIZED_BODY
    extern template class PIMPLHandle<MobilizedBody::Custom::Implementation, 
                                      MobilizedBody::Custom::ImplementationImpl>;
#endif
 
 
//==============================================================================
//                  MOBILIZED BODY :: CUSTOM :: IMPLEMENTATION
//==============================================================================
class SimTK_SIMBODY_EXPORT MobilizedBody::Custom::Implementation 
  : public PIMPLHandle<Implementation,ImplementationImpl> 
{
public:
    // No default constructor because you have to supply at least the SimbodyMatterSubsystem
    // to which this MobilizedBody belongs.
 
    virtual ~Implementation();
 
    virtual Implementation* clone() const = 0;
 
    Implementation(SimbodyMatterSubsystem&, int nu, int nq, int nAngles=0);
 
    Vector getQ(const State& s) const;
    
    Vector getU(const State& s) const;
 
    Vector getQDot(const State& s) const;
 
    Vector getUDot(const State& s) const;
    
    Vector getQDotDot(const State& s) const;
 
    Transform getMobilizerTransform(const State& s) const;
 
    SpatialVec getMobilizerVelocity(const State& s) const;
 
    bool getUseEulerAngles(const State& s) const;
 
    void invalidateTopologyCache() const;
 
 
 
    virtual Transform calcMobilizerTransformFromQ(const State& s, int nq, const Real* q) const = 0;
 
 
    virtual SpatialVec multiplyByHMatrix(const State& s, int nu, const Real* u) const = 0;
 
    virtual void multiplyByHTranspose(const State& s, const SpatialVec& F, int nu, Real* f) const = 0;
 
    virtual SpatialVec multiplyByHDotMatrix(const State& s, int nu, const Real* u) const = 0;
 
    virtual void multiplyByHDotTranspose(const State& s, const SpatialVec& F, int nu, Real* f) const = 0;
 
    virtual void multiplyByN(const State& s, bool transposeMatrix, 
                             int nIn, const Real* in, int nOut, Real* out) const;
 
    virtual void multiplyByNInv(const State& s, bool transposeMatrix, 
                                int nIn, const Real* in, int nOut, Real* out) const;
 
    virtual void multiplyByNDot(const State& s, bool transposeMatrix, 
                                int nIn, const Real* in, int nOut, Real* out) const;
 
        // Methods for setting Mobilizer initial conditions. Note -- I've stripped this
        // down to the two basic routines but the built-ins have 8 so that you can 
        // specify only rotations or translations. I'm not sure that's needed here and
        // I suppose you could add more routines later if needed.
        // Eventually it might be nice to provide default implementation here that would
        // use a root finder to attempt to solve these initial condition problems. For
        // most joints there is a much more direct way to do it, and sometimes there
        // are behavioral choices to make, which is why it is nice to have mobilizer-specific
        // overrides for these.
 
    virtual void setQToFitTransform(const State&, const Transform& X_FM, int nq, Real* q) const;
 
    virtual void setUToFitVelocity(const State&, const SpatialVec& V_FM, int nu, Real* u) const;
 
    virtual void calcDecorativeGeometryAndAppend
       (const State& s, Stage stage, Array_<DecorativeGeometry>& geom) const
    {
    }
 
 
 
    virtual void realizeTopology(State&) const { }
 
    virtual void realizeModel(State&) const { }
 
    virtual void realizeInstance(const State&) const { }
 
    virtual void realizeTime(const State&) const { }
 
    virtual void realizePosition(const State&) const { }
 
    virtual void realizeVelocity(const State&) const { }
 
    virtual void realizeDynamics(const State&) const { }
 
    virtual void realizeAcceleration(const State&) const { }
 
    virtual void realizeReport(const State&) const { }
 
    friend class MobilizedBody::CustomImpl;
};
 
} // namespace SimTK
 
#endif // SimTK_SIMBODY_MOBILIZED_BODY_CUSTOM_H_