small improvements
							parent
							
								
									b3635cc6ce
								
							
						
					
					
						commit
						b0404aa109
					
				|  | @ -65,9 +65,7 @@ GaussianFactorGraph::shared_ptr LPInitSolver::buildInitOfInitGraph() const { | |||
|       new GaussianFactorGraph(lp_.equalities)); | ||||
| 
 | ||||
|   // create factor ||x||^2 and add to the graph
 | ||||
|   const KeyDimMap& constrainedKeyDim = lp_.constrainedKeyDimMap(); | ||||
|   for (const auto& [key, _] : constrainedKeyDim) { | ||||
|     size_t dim = constrainedKeyDim.at(key); | ||||
|   for (const auto& [key, dim] : lp_.constrainedKeyDimMap()) { | ||||
|     initGraph->push_back( | ||||
|         JacobianFactor(key, Matrix::Identity(dim, dim), Vector::Zero(dim))); | ||||
|   } | ||||
|  |  | |||
|  | @ -19,6 +19,7 @@ | |||
| 
 | ||||
| #pragma once | ||||
| 
 | ||||
| #include <gtsam_unstable/dllexport.h> | ||||
| #include <gtsam_unstable/linear/LP.h> | ||||
| #include <gtsam/linear/GaussianFactorGraph.h> | ||||
| 
 | ||||
|  | @ -49,7 +50,7 @@ namespace gtsam { | |||
|  * inequality constraint, we can't conclude that the problem is infeasible. | ||||
|  * However, whether it is infeasible or unbounded, we don't have a unique solution anyway. | ||||
|  */ | ||||
| class LPInitSolver { | ||||
| class GTSAM_UNSTABLE_EXPORT LPInitSolver { | ||||
| private: | ||||
|   const LP& lp_; | ||||
| 
 | ||||
|  |  | |||
		Loading…
	
		Reference in New Issue