Constraint_SphereOnSphereContact.h

Go to the documentation of this file.

#ifndef SimTK_SIMBODY_CONSTRAINT_SPHERE_ON_SPHERE_CONTACT_H_
#define SimTK_SIMBODY_CONSTRAINT_SPHERE_ON_SPHERE_CONTACT_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) 2014 Stanford University and the Authors.           *
 * Authors: 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/Constraint.h"

namespace SimTK {

//==============================================================================
//                        SPHERE ON SPHERE CONTACT
//==============================================================================
class SimTK_SIMBODY_EXPORT Constraint::SphereOnSphereContact
:   public Constraint  {
public:
    // no default constructor

//------------------------------------------------------------------------------

SphereOnSphereContact(  MobilizedBody&      mobod_F, 
                        const Vec3&         defaultCenterOnF, 
                        Real                defaultRadiusOnF, 
                        MobilizedBody&      mobod_B, 
                        const Vec3&         defaultCenterOnB,
                        Real                defaultRadiusOnB,
                        bool                enforceRolling);
    
SphereOnSphereContact() {}

const MobilizedBody& getMobilizedBodyF() const;

const MobilizedBody& getMobilizedBodyB() const;

bool isEnforcingRolling() const;

SphereOnSphereContact& 
setDefaultCenterOnF(const Vec3& defaultCenter);
SphereOnSphereContact& 
setDefaultRadiusOnF(Real defaultRadius);
SphereOnSphereContact& 
setDefaultCenterOnB(const Vec3& defaultCenter);
SphereOnSphereContact& 
setDefaultRadiusOnB(Real defaultRadius);

const Vec3& getDefaultCenterOnF() const;
Real getDefaultRadiusOnF() const;
const Vec3& getDefaultCenterOnB() const;
Real getDefaultRadiusOnB() const;
//------------------------------------------------------------------------------
    // nothing yet
//------------------------------------------------------------------------------

const SphereOnSphereContact& 
setCenterOnF(State& state, const Vec3& sphereCenter) const;

const SphereOnSphereContact& 
setRadiusOnF(State& state, Real sphereRadius) const;

const SphereOnSphereContact& 
setCenterOnB(State& state, const Vec3& sphereCenter) const;

const SphereOnSphereContact& 
setRadiusOnB(State& state, Real sphereRadius) const;

const Vec3& getCenterOnF(const State& state) const;
Real getRadiusOnF(const State& state) const;

const Vec3& getCenterOnB(const State& state) const;
Real getRadiusOnB(const State& state) const;
//------------------------------------------------------------------------------
Real getPositionError(const State& state) const;

Vec3 getVelocityErrors(const State& state) const;

Vec3 getAccelerationErrors(const State& state) const;

Vec3 getMultipliers(const State& state) const;

Vec3 findForceOnSphereBInG(const State& state) const;

Transform findContactFrameInG(const State& state) const;

Real findSeparation(const State& state) const; // hide from Doxygen
SimTK_INSERT_DERIVED_HANDLE_DECLARATIONS
    (SphereOnSphereContact, SphereOnSphereContactImpl, Constraint);
};

} // namespace SimTK

#endif // SimTK_SIMBODY_CONSTRAINT_SPHERE_ON_SPHERE_CONTACT_H_