Alex Cunningham
37bc303492
Added weighted Householder transforms that use precisions perform QDR factorization. Functions create a weighted vector pseudoinverse, and then use the pseudoinverse to substitute a solution into system.
2009-10-27 14:21:22 +00:00
Frank Dellaert
626d06905c
Removed obsolete optimize call and documented better
2009-10-27 14:14:36 +00:00
Frank Dellaert
4d9ff77249
moved timing example here from EasySLAM
2009-10-27 13:34:36 +00:00
Frank Dellaert
422169873c
moved [symbol] function to LinearFactor
2009-10-27 13:33:44 +00:00
Brian Law
11f0d04cb6
made all classes that currently have an assert_equal "Testable"
...
- derive from testable as in class Point2 : Testable<Point2>
- moved print and equal declarations in .h right after the constructor
- similarly, moved implementations after constructors in .cpp file
- removed obsolete assert_equal
2009-10-26 19:26:51 +00:00
Frank Dellaert
3b30fe50b0
Moved print and equals to -inl.h
2009-10-25 22:27:18 +00:00
Frank Dellaert
7a968962db
Order of arguments = expected, then actual
2009-10-25 22:26:56 +00:00
Frank Dellaert
57bc102548
Equals now checks for NULLs
2009-10-25 14:25:17 +00:00
Frank Dellaert
f54ba387fe
FactorGraph, ChordalBayesNet, and ConditionalGaussian now Testable
2009-10-24 23:14:14 +00:00
Frank Dellaert
3792c79706
Fixed NonlinearFactor2 equals and added some unit tests for equals
2009-10-24 20:01:47 +00:00
Viorela Ila
06a7898da2
add the execution time test
2009-10-24 14:09:30 +00:00
Viorela Ila
ebd6fb96d8
create a map and trajectory (not rand)
2009-10-24 14:06:17 +00:00
Frank Dellaert
563abc2b3f
formatting only
2009-10-24 04:07:32 +00:00
Chris Beall
baef89ccf0
updated find_factors_and_remove to use map of factor indices to gather factors connected to a variable. factors are set to null instead of being erased. also updated size() to count non-NULL factors, and print() to only print non-NULL factors. added new unit test which tries to remove the same variable twice.
2009-10-23 00:56:40 +00:00
Chris Beall
52bedcad3a
order 1 factors by using map
2009-10-22 21:33:00 +00:00
Frank Dellaert
cd3e3d8a86
Fairly substantial change: Factor now Testable, MutableLinearFactor gone
...
The latter was prompted by the fact that assert_equal did not like mixing LinearFactor and MutableLinearFactor
But MutableLinearFactor always was a bit of a kluge. We should eradicate all non-const on LinearFactor some other way.
2009-10-22 17:23:24 +00:00
Richard Roberts
0d580032c5
Added unit test for creating an n-ary LinearFactor
2009-10-22 15:52:39 +00:00
Frank Dellaert
2aec16d3cf
Combined evaluation/derivatives now return the function value instead of using a pointer
2009-10-22 14:44:27 +00:00
Frank Dellaert
6c8531ed9c
Point2 now Testable, removed obsolete assert_equal, as every testable class can use the template version in Testable.h
2009-10-22 14:43:36 +00:00
Frank Dellaert
9a579fcdaf
No need for Testable constructors
2009-10-22 14:42:19 +00:00
Richard Roberts
e52c574e46
Added an empty virtual destructor to fix a compile warning
2009-10-22 14:27:44 +00:00
Richard Roberts
ae57441c3d
Added a constructor to create an n-ary factor from an std::vector of key/A-matrix pairs
2009-10-22 14:27:03 +00:00
Frank Dellaert
c3b8a20b5c
Added new test for find_factors_and_remove and deleted obsolete one
2009-10-22 13:28:37 +00:00
Frank Dellaert
1b199a4d3b
Added a "factors" function that returns indices to all factors connected to a variable.
2009-10-22 05:02:31 +00:00
Frank Dellaert
41c1d7a898
no more FGConfig
2009-10-22 05:00:24 +00:00
Viorela Ila
3e6739f2fd
Now Matlab toolbox compiles!!
2009-10-20 20:41:45 +00:00
Viorela Ila
019a05d93d
mex: compile of ' "eliminate.cpp"' error fixed. but still not compiling
2009-10-20 18:57:33 +00:00
Frank Dellaert
543ad1409f
Changing from set to vector: insert -> push_back
2009-10-20 15:22:06 +00:00
Frank Dellaert
19bdb5c2f9
Better name for delta: linearizeAndOptimizeForDelta
2009-10-19 19:12:48 +00:00
Frank Dellaert
d8c04ecfcb
Fixed serialization include header.
2009-10-18 17:35:15 +00:00
Frank Dellaert
ed616a26ed
Finally gave in and made LinearFactorSet into a vector. Pragmatism wins.
2009-10-18 16:49:10 +00:00
Frank Dellaert
82d541f6a3
Fixed wrapper problem
...
This was because VectorConfig was parsed as Vector. Just changing the order of the parsers fixed this.
2009-10-17 04:29:14 +00:00
Frank Dellaert
0d66ee8f72
comments only
2009-10-15 14:56:40 +00:00
Alex Cunningham
485f8d003b
Added notes concerning the ordering issue when handling sets of LinearFactor::shared_ptrs
2009-10-14 21:06:44 +00:00
Alex Cunningham
7d0a30c20f
Renamed FGConfig to VectorConfig in gtsam, easylib, EasySLAM, and mast.
2009-10-14 20:39:59 +00:00
Alex Cunningham
8f20523e7f
ConstrainedLinearFactorGraphs now handles multiple constraints on a node properly.
...
smallExample was changed to include two of the examples used in testConstrainedLinearFactorGraph
ConditionalGaussian was changed to make solve() virtual, as this is necessary for ConstrainedConditionalGaussian
2009-10-14 15:32:05 +00:00
Chris Beall
92b920cb48
updated to be templated on Config.
2009-10-13 20:55:07 +00:00
Alex Cunningham
66dac8a52f
Generalized constraint handling to create a LinearConstraint which implements linear equality constraints that can be eliminated as a part of a ConstrainedLinearFactorGraph. DeltaFunction has been changed to be a ConstrainedConditionalGaussian, which has a more robust solve() function. The new tests no longer use the "constrained" example from smallExample, so those functions have been commented.
...
''Limitations: ''
* Any given node can only have one constraint on it, but constraints can be of arbitrary size
* Constraints can only be specified as a blockwise system, where each block must be square and invertible to support arbitrary elimination orderings.
* ConstrainedNonlinearFactorGraph is disabled until a better solution for handling constraints in the nonlinear case is determined.
2009-10-08 13:57:22 +00:00
Alex Cunningham
3efe95abee
Removed ConstrainedChordalBayesNet and associated test. It may return if ConstrainedConditionalGaussians need more involved processing in future versions, but for all versions of LinearConstraint, there is no need for a special Constrained CBN.
2009-10-08 13:43:43 +00:00
Frank Dellaert
989f290c99
'''BIG CHANGE''': avoid converting back and to FGConfigs by templating on configuration type. Details:
...
* Factors are now templated on the configuration type. Factor Graphs are now templated on the factor type and configuration type.
* LinearFactor is a factor on an FGConfig.
* LinearFactorGraph uses LinearFactor and FGConfig.
* NonLinearFactor is still templated on Config.
* NonLinearFactorGraph uses NonLinearFactors, but is still templated on Config.
* Tests and VSLAMFactor have been updated to reflect those changes.
2009-10-06 18:25:04 +00:00
Frank Dellaert
34c1bb6f29
Small comment on exmap correctness
2009-10-06 18:02:33 +00:00
Frank Dellaert
7e77ae5f53
formatting only, clear by default
2009-10-06 18:01:40 +00:00
Kai Ni
354f9de64e
fixed round off error in Rot3.rodriguez
2009-09-16 02:20:57 +00:00
Kai Ni
7fb691183d
make simulation2D work
2009-09-15 22:32:34 +00:00
Kai Ni
53b4f8906b
make incremental optimization function return poses for unit test purpose
2009-09-14 06:40:53 +00:00
Frank Dellaert
768befbd85
Faster inverse by avoiding matrix intermediate
2009-09-14 04:39:36 +00:00
Frank Dellaert
d5dc9ab9d1
Composition is faster, composeTransform is trivial (and should probably go)
2009-09-14 04:38:17 +00:00
Manohar Paluri
3285d88181
Added few utility functions required to check if Marker is facing the Camera
2009-09-13 20:07:00 +00:00
Kai Ni
100b9b2eec
added a safe projection method to Calibrated and SimpleCamera. added a positiveDepth property to ARToolkitMeasurement so that the visibility can be checked
2009-09-13 16:09:54 +00:00
Manohar Paluri
571c0da8d1
removed unit test for scalar operator overloading
2009-09-13 04:23:31 +00:00