AllDiff.h

Go to the documentation of this file.

/*
 * AllDiff.h
 * @brief General "all-different" constraint
 * @date Feb 6, 2012
 * @author Frank Dellaert
 */
 
#pragma once
 
#include <gtsam/discrete/DiscreteKey.h>
#include <gtsam_unstable/discrete/BinaryAllDiff.h>
 
namespace gtsam {
 
class GTSAM_UNSTABLE_EXPORT AllDiff : public Constraint {
  std::map<Key, size_t> cardinalities_;
 
  DiscreteKey discreteKey(size_t i) const {
    Key j = keys_[i];
    return DiscreteKey(j, cardinalities_.at(j));
  }
 
 public:
  AllDiff(const DiscreteKeys& dkeys);
 
  // print
  void print(const std::string& s = "", const KeyFormatter& formatter =
                                            DefaultKeyFormatter) const override;
 
  bool equals(const DiscreteFactor& other, double tol) const override {
    if (!dynamic_cast<const AllDiff*>(&other))
      return false;
    else {
      const AllDiff& f(static_cast<const AllDiff&>(other));
      return cardinalities_.size() == f.cardinalities_.size() &&
             std::equal(cardinalities_.begin(), cardinalities_.end(),
                        f.cardinalities_.begin());
    }
  }
 
  double operator()(const DiscreteValues& values) const override;
 
  DecisionTreeFactor toDecisionTreeFactor() const override;
 
  DecisionTreeFactor operator*(const DecisionTreeFactor& f) const override;
 
  AlgebraicDecisionTree<Key> errorTree() const override {
    throw std::runtime_error("AllDiff::error not implemented");
  }
 
  /*
   * Ensure Arc-consistency by checking every possible value of domain j.
   * @param j domain to be checked
   * @param (in/out) domains all domains, but only domains->at(j) will be checked.
   * @return true if domains->at(j) was changed, false otherwise.
   */
  bool ensureArcConsistency(Key j, Domains* domains) const override;
 
  Constraint::shared_ptr partiallyApply(const DiscreteValues&) const override;
 
  Constraint::shared_ptr partiallyApply(
      const Domains&) const override;
};
 
}  // namespace gtsam