| 
									
										
										
										
											2010-01-23 01:36:57 +08:00
										 |  |  | class SharedGaussian { | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | 	SharedGaussian(Matrix covariance); | 
					
						
							|  |  |  | 	SharedGaussian(Vector sigmas); | 
					
						
							| 
									
										
										
										
											2010-01-23 01:36:57 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class SharedDiagonal { | 
					
						
							|  |  |  | 	SharedDiagonal(Vector sigmas); | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-12 06:45:08 +08:00
										 |  |  | class Ordering { | 
					
						
							|  |  |  |   Ordering(); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-01-05 02:07:24 +08:00
										 |  |  |   bool equals(const Ordering& ord, double tol) const; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void push_back(string s); | 
					
						
							| 
									
										
										
										
											2009-11-12 06:45:08 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  | class VectorValues { | 
					
						
							|  |  |  |   VectorValues(); | 
					
						
							| 
									
										
										
										
											2010-10-22 08:24:26 +08:00
										 |  |  |   VectorValues(size_t nVars, size_t varDim); | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   bool equals(const VectorValues& expected, double tol) const; | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  |   size_t size() const; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-10-22 08:24:26 +08:00
										 |  |  | class GaussianFactor { | 
					
						
							|  |  |  | 	void print(string s) const; | 
					
						
							|  |  |  | 	bool equals(const GaussianFactor& lf, double tol) const; | 
					
						
							|  |  |  | 	bool empty() const; | 
					
						
							|  |  |  | 	Vector getb() const; | 
					
						
							|  |  |  | 	double error(const VectorValues& c) const; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-01-23 01:36:57 +08:00
										 |  |  | class GaussianFactorSet { | 
					
						
							|  |  |  |   GaussianFactorSet(); | 
					
						
							|  |  |  |   void push_back(GaussianFactor* factor); | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-13 00:41:18 +08:00
										 |  |  | class GaussianConditional { | 
					
						
							|  |  |  |   GaussianConditional(); | 
					
						
							| 
									
										
										
										
											2009-11-12 06:45:08 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2009-11-13 00:41:18 +08:00
										 |  |  |   bool equals(const GaussianConditional &cg, double tol) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   Vector solve(const VectorValues& x); | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-01 03:53:20 +08:00
										 |  |  | class GaussianBayesNet { | 
					
						
							|  |  |  |   GaussianBayesNet(); | 
					
						
							| 
									
										
										
										
											2009-11-12 06:45:08 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							|  |  |  |   bool equals(const GaussianBayesNet& cbn, double tol) const; | 
					
						
							| 
									
										
										
										
											2009-11-13 00:41:18 +08:00
										 |  |  |   void push_back(GaussianConditional* conditional); | 
					
						
							|  |  |  |   void push_front(GaussianConditional* conditional); | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-11-13 00:16:32 +08:00
										 |  |  | class GaussianFactorGraph { | 
					
						
							|  |  |  |   GaussianFactorGraph(); | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							|  |  |  |   bool equals(const GaussianFactorGraph& lfgraph, double tol) const; | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  | 
 | 
					
						
							|  |  |  |   size_t size() const; | 
					
						
							| 
									
										
										
										
											2009-11-13 00:16:32 +08:00
										 |  |  |   void push_back(GaussianFactor* ptr_f); | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const VectorValues& c) const; | 
					
						
							|  |  |  |   double probPrime(const VectorValues& c) const; | 
					
						
							| 
									
										
										
										
											2009-12-02 00:01:29 +08:00
										 |  |  |   void combine(const GaussianFactorGraph& lfg); | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class Point2 { | 
					
						
							|  |  |  |   Point2(); | 
					
						
							|  |  |  |   Point2(double x, double y); | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  |   double x(); | 
					
						
							|  |  |  |   double y(); | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class Point3 { | 
					
						
							|  |  |  |   Point3(); | 
					
						
							|  |  |  |   Point3(double x, double y, double z); | 
					
						
							|  |  |  |   Point3(Vector v); | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2009-08-22 06:23:24 +08:00
										 |  |  |   Vector vector() const; | 
					
						
							|  |  |  |   double x(); | 
					
						
							|  |  |  |   double y(); | 
					
						
							|  |  |  |   double z(); | 
					
						
							|  |  |  | };  | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-01-05 02:07:24 +08:00
										 |  |  | class Pose2 { | 
					
						
							|  |  |  |   Pose2(); | 
					
						
							|  |  |  |   Pose2(const Pose2& pose); | 
					
						
							|  |  |  |   Pose2(double x, double y, double theta); | 
					
						
							|  |  |  |   Pose2(double theta, const Point2& t); | 
					
						
							|  |  |  |   Pose2(const Rot2& r, const Point2& t); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							|  |  |  |   bool equals(const Pose2& pose, double tol) const; | 
					
						
							|  |  |  |   double x() const; | 
					
						
							|  |  |  |   double y() const; | 
					
						
							|  |  |  |   double theta() const; | 
					
						
							| 
									
										
										
										
											2010-01-11 05:53:38 +08:00
										 |  |  |   size_t dim() const; | 
					
						
							|  |  |  |   Pose2 expmap(const Vector& v) const; | 
					
						
							|  |  |  |   Vector logmap(const Pose2& pose) const; | 
					
						
							| 
									
										
										
										
											2010-01-05 02:07:24 +08:00
										 |  |  |   Point2 t() const; | 
					
						
							|  |  |  |   Rot2 r() const; | 
					
						
							| 
									
										
										
										
											2009-12-10 03:55:25 +08:00
										 |  |  | }; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  | class Simulated2DValues { | 
					
						
							|  |  |  | 	Simulated2DValues(); | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							|  |  |  | 	void insertPose(int i, const Point2& p); | 
					
						
							|  |  |  | 	void insertPoint(int j, const Point2& p); | 
					
						
							|  |  |  | 	int nrPoses() const; | 
					
						
							|  |  |  | 	int nrPoints() const; | 
					
						
							|  |  |  | 	Point2* pose(int i); | 
					
						
							|  |  |  | 	Point2* point(int j); | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  | class Simulated2DOrientedValues { | 
					
						
							|  |  |  | 	Simulated2DOrientedValues(); | 
					
						
							| 
									
										
										
										
											2010-04-08 03:09:14 +08:00
										 |  |  |   void print(string s) const; | 
					
						
							|  |  |  | 	void insertPose(int i, const Pose2& p); | 
					
						
							|  |  |  | 	void insertPoint(int j, const Point2& p); | 
					
						
							|  |  |  | 	int nrPoses() const; | 
					
						
							|  |  |  | 	int nrPoints() const; | 
					
						
							|  |  |  | 	Pose2* pose(int i); | 
					
						
							|  |  |  | 	Point2* point(int j); | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | class Simulated2DPosePrior { | 
					
						
							|  |  |  | 	Simulated2DPosePrior(Point2& mu, const SharedDiagonal& model, int i); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-04-08 03:09:14 +08:00
										 |  |  | class Simulated2DOrientedPosePrior { | 
					
						
							|  |  |  | 	Simulated2DOrientedPosePrior(Pose2& mu, const SharedDiagonal& model, int i); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DOrientedValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-04-08 03:09:14 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | class Simulated2DPointPrior { | 
					
						
							|  |  |  | 	Simulated2DPointPrior(Point2& mu, const SharedDiagonal& model, int i); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | class Simulated2DOdometry { | 
					
						
							|  |  |  |   Simulated2DOdometry(Point2& mu, const SharedDiagonal& model, int i1, int i2); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-04-08 05:27:16 +08:00
										 |  |  | class Simulated2DOrientedOdometry { | 
					
						
							|  |  |  | 	Simulated2DOrientedOdometry(Pose2& mu, const SharedDiagonal& model, int i1, int i2); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DOrientedValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-04-08 05:27:16 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | class Simulated2DMeasurement { | 
					
						
							|  |  |  |   Simulated2DMeasurement(Point2& mu, const SharedDiagonal& model, int i, int j); | 
					
						
							|  |  |  |   void print(string s) const; | 
					
						
							| 
									
										
										
										
											2010-10-09 11:09:58 +08:00
										 |  |  |   double error(const Simulated2DValues& c) const; | 
					
						
							| 
									
										
										
										
											2010-02-23 13:06:16 +08:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 |