contact_managers_plugin_factory.h

Go to the documentation of this file.

 
#ifndef TESSERACT_COLLISION_CONTACT_MANAGERS_PLUGIN_FACTORY_H
#define TESSERACT_COLLISION_CONTACT_MANAGERS_PLUGIN_FACTORY_H
 
#include <tesseract_common/macros.h>
TESSERACT_COMMON_IGNORE_WARNINGS_PUSH
#include <string>
#include <memory>
#include <map>
#include <yaml-cpp/yaml.h>
TESSERACT_COMMON_IGNORE_WARNINGS_POP
 
#include <tesseract_collision/core/discrete_contact_manager.h>
#include <tesseract_collision/core/continuous_contact_manager.h>
#include <tesseract_common/plugin_loader.h>
#include <tesseract_common/types.h>
 
// clang-format off
#define TESSERACT_ADD_DISCRETE_MANAGER_PLUGIN(DERIVED_CLASS, ALIAS)                                                    \
  TESSERACT_ADD_PLUGIN_SECTIONED(DERIVED_CLASS, ALIAS, DiscColl)
 
#define TESSERACT_ADD_CONTINUOUS_MANAGER_PLUGIN(DERIVED_CLASS, ALIAS)                                                  \
  TESSERACT_ADD_PLUGIN_SECTIONED(DERIVED_CLASS, ALIAS, ContColl)
// clang-format on
 
namespace tesseract_collision
{
class ContactManagersPluginFactory;
 
class DiscreteContactManagerFactory
{
public:
  using Ptr = std::shared_ptr<DiscreteContactManagerFactory>;
  using ConstPtr = std::shared_ptr<const DiscreteContactManagerFactory>;
 
  virtual ~DiscreteContactManagerFactory() = default;
 
  virtual DiscreteContactManager::UPtr create(const std::string& name, const YAML::Node& config) const = 0;
 
protected:
  static const std::string SECTION_NAME;
  friend class PluginLoader;
};
 
class ContinuousContactManagerFactory
{
public:
  using Ptr = std::shared_ptr<ContinuousContactManagerFactory>;
  using ConstPtr = std::shared_ptr<const ContinuousContactManagerFactory>;
 
  virtual ~ContinuousContactManagerFactory() = default;
 
  virtual ContinuousContactManager::UPtr create(const std::string& solver_name, const YAML::Node& config) const = 0;
 
protected:
  static const std::string SECTION_NAME;
  friend class PluginLoader;
};
 
class ContactManagersPluginFactory
{
public:
  ContactManagersPluginFactory();
  ~ContactManagersPluginFactory();
  ContactManagersPluginFactory(const ContactManagersPluginFactory&) = default;
  ContactManagersPluginFactory& operator=(const ContactManagersPluginFactory&) = default;
  ContactManagersPluginFactory(ContactManagersPluginFactory&&) = default;
  ContactManagersPluginFactory& operator=(ContactManagersPluginFactory&&) = default;
 
  ContactManagersPluginFactory(YAML::Node config);
 
  ContactManagersPluginFactory(const tesseract_common::fs::path& config);
 
  ContactManagersPluginFactory(const std::string& config);
 
  void addSearchPath(const std::string& path);
 
  std::set<std::string> getSearchPaths() const;
 
  void clearSearchPaths();
 
  void addSearchLibrary(const std::string& library_name);
 
  std::set<std::string> getSearchLibraries() const;
 
  void clearSearchLibraries();
 
  void addDiscreteContactManagerPlugin(const std::string& name, tesseract_common::PluginInfo plugin_info);
 
  bool hasDiscreteContactManagerPlugins() const;
 
  tesseract_common::PluginInfoMap getDiscreteContactManagerPlugins() const;
 
  void removeDiscreteContactManagerPlugin(const std::string& name);
 
  void setDefaultDiscreteContactManagerPlugin(const std::string& name);
 
  std::string getDefaultDiscreteContactManagerPlugin() const;
 
  void addContinuousContactManagerPlugin(const std::string& name, tesseract_common::PluginInfo plugin_info);
 
  bool hasContinuousContactManagerPlugins() const;
 
  tesseract_common::PluginInfoMap getContinuousContactManagerPlugins() const;
 
  void removeContinuousContactManagerPlugin(const std::string& name);
 
  void setDefaultContinuousContactManagerPlugin(const std::string& name);
 
  std::string getDefaultContinuousContactManagerPlugin() const;
 
  DiscreteContactManager::UPtr createDiscreteContactManager(const std::string& name) const;
 
  DiscreteContactManager::UPtr createDiscreteContactManager(const std::string& name,
                                                            const tesseract_common::PluginInfo& plugin_info) const;
 
  ContinuousContactManager::UPtr createContinuousContactManager(const std::string& name) const;
 
  ContinuousContactManager::UPtr createContinuousContactManager(const std::string& name,
                                                                const tesseract_common::PluginInfo& plugin_info) const;
 
  void saveConfig(const boost::filesystem::path& file_path) const;
 
  YAML::Node getConfig() const;
 
private:
  mutable std::map<std::string, DiscreteContactManagerFactory::Ptr> discrete_factories_;
  mutable std::map<std::string, ContinuousContactManagerFactory::Ptr> continuous_factories_;
  tesseract_common::PluginInfoContainer discrete_plugin_info_;
  tesseract_common::PluginInfoContainer continuous_plugin_info_;
  tesseract_common::PluginLoader plugin_loader_;
};
}  // namespace tesseract_collision
#endif  // TESSERACT_COLLISION_CONTACT_MANAGERS_PLUGIN_FACTORY_H