GetContacts.hh

Go to the documentation of this file.

/*
 * Copyright (C) 2019 Open Source Robotics Foundation
 *
 * 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.
 *
 */
 
#ifndef GZ_PHYSICS_GETCONTACTS_HH_
#define GZ_PHYSICS_GETCONTACTS_HH_
 
#include <vector>
#include <gz/physics/FeatureList.hh>
#include <gz/physics/ForwardStep.hh>
#include <gz/physics/Geometry.hh>
#include <gz/physics/SpecifyData.hh>
 
namespace gz
{
namespace physics
{
class GZ_PHYSICS_VISIBLE GetContactsFromLastStepFeature
    : public virtual FeatureWithRequirements<ForwardStep>
{
  public: template <typename PolicyT>
  struct ExtraContactDataT
  {
    using Scalar = typename PolicyT::Scalar;
    using VectorType = typename FromPolicy<PolicyT>::template Use<Vector>;
 
    VectorType force;
    VectorType normal;
    Scalar depth;
  };
 
  public: template <typename PolicyT, typename FeaturesT>
  class World : public virtual Feature::World<PolicyT, FeaturesT>
  {
    public: using Scalar = typename PolicyT::Scalar;
    public: using ShapePtrType = ShapePtr<PolicyT, FeaturesT>;
    public: using VectorType =
        typename FromPolicy<PolicyT>::template Use<Vector>;
    public: using ExtraContactData = ExtraContactDataT<PolicyT>;
 
    public: struct ContactPoint
    {
      ShapePtrType collision1;
      ShapePtrType collision2;
      VectorType point;
    };
 
    public: using Contact = SpecifyData<
            RequireData<ContactPoint>,
            ExpectData<ExtraContactData> >;
 
    public: std::vector<Contact> GetContactsFromLastStep() const;
  };
 
  public: template <typename PolicyT>
  class Implementation : public virtual Feature::Implementation<PolicyT>
  {
    public: using Scalar = typename PolicyT::Scalar;
    public: using VectorType =
        typename FromPolicy<PolicyT>::template Use<Vector>;
    public: using ExtraContactData = ExtraContactDataT<PolicyT>;
 
    public: struct ContactInternal
    {
      Identity collision1;
      Identity collision2;
      VectorType point;
      CompositeData extraData;
    };
 
    public: virtual std::vector<ContactInternal> GetContactsFromLastStep(
        const Identity &_worldID) const = 0;
  };
};
}
}
 
#include "gz/physics/detail/GetContacts.hh"
 
#endif /* end of include guard: GZ_PHYSICS_GETCONTACTS_HH_ */