LPInitSolver.h

Go to the documentation of this file.

/* ----------------------------------------------------------------------------
 
 * GTSAM Copyright 2010, Georgia Tech Research Corporation,
 * Atlanta, Georgia 30332-0415
 * All Rights Reserved
 * Authors: Frank Dellaert, et al. (see THANKS for the full author list)
 
 * See LICENSE for the license information
 
 * -------------------------------------------------------------------------- */

 
#pragma once
 
#include <gtsam/config.h>
 
#ifdef GTSAM_ALLOW_DEPRECATED_SINCE_V43
 
#include <gtsam/linear/GaussianFactorGraph.h>
#include <gtsam_unstable/dllexport.h>
#include <gtsam_unstable/linear/LP.h>
 
namespace gtsam {
class GTSAM_UNSTABLE_EXPORT LPInitSolver {
 private:
  const LP& lp_;
 
 public:
  LPInitSolver(const LP& lp) : lp_(lp) {}

  VectorValues solve() const;
 
 private:
  LP::shared_ptr buildInitialLP(Key yKey) const;

  GaussianFactorGraph::shared_ptr buildInitOfInitGraph() const;

  double compute_y0(const VectorValues& x0) const;

  std::vector<std::pair<Key, Matrix>> collectTerms(
      const LinearInequality& factor) const;

  InequalityFactorGraph addSlackVariableToInequalities(
      Key yKey, const InequalityFactorGraph& inequalities) const;
 
  // friend class for unit-testing private methods
  friend class LPInitSolverInitializationTest;
};
 
}  // namespace gtsam
 
#endif  // GTSAM_ALLOW_DEPRECATED_SINCE_V43