Luca Carlone
b51a8380c4
added boost include
2013-10-12 16:21:15 +00:00
Duy-Nguyen Ta
8be7363a01
refactor and add more comments
2013-10-12 15:27:37 +00:00
Duy-Nguyen Ta
b161a106c7
loopy belief in progress
2013-10-12 05:49:11 +00:00
Duy-Nguyen Ta
35924f6055
disable printing
2013-10-11 21:59:36 +00:00
Duy-Nguyen Ta
2570492fa6
disable printing
2013-10-11 21:58:09 +00:00
Duy-Nguyen Ta
a5f1d68099
fix scheduling examples by adding the default key index ordering in Scheduler.
2013-10-11 21:55:31 +00:00
Duy-Nguyen Ta
19d64460ba
check in fail DiscreteBayesNet::sample unittest.
2013-10-11 19:07:16 +00:00
Duy-Nguyen Ta
8add3de3c2
fix compilation errors in unstable discrete examples
2013-10-11 19:01:12 +00:00
Duy-Nguyen Ta
1531abd285
fix testCSP by using the default key ordering.
2013-10-11 17:48:44 +00:00
Duy-Nguyen Ta
bf11f93cee
revive unstable discrete. testCSP still fails, but looks like the solution is valid. See comments in file.
2013-10-11 17:42:30 +00:00
Zsolt Kira
9639660685
Added GenericProjectionFactorCreator. Both smart and generic projection factors now work (again) in batch mode. Incremental not tested yet.
2013-10-11 01:59:36 +00:00
Zsolt Kira
1a8a670870
Fixed bugs in new version since creator class is used: Get number of landmarks from creator object,
...
replace ensureHasOrdering with direct COLAMD call.
Current Smart Projection factor version works in batch mode
2013-10-10 20:21:40 +00:00
Chris Beall
e799c9ffa9
tabs converted to two spaces
2013-10-10 17:52:57 +00:00
Luca Carlone
121e71431a
SmartFactorsCreator + initial fix in kitti example
2013-10-09 17:13:19 +00:00
Luca Carlone
426b4d79cf
testSmartProjectionFactor - disabled
2013-10-08 14:28:50 +00:00
Luca Carlone
444df1958a
Kitti test not working
2013-10-06 18:17:35 +00:00
Luca Carlone
d049dd38c6
Incremental mode in Smart Factors (not working yet with standard ProjectionFactors)
2013-10-06 18:17:32 +00:00
Zsolt Kira
83182b05ca
Second method for landmark-first ordering: Provide a constrained ordering with landmarks in group 1 and poses in group 2
2013-10-04 14:25:19 +00:00
Zsolt Kira
cc724134a6
Added ability to run both smart and projection factor version (for comparison)
...
For projection factor version, we can specify a landmark-first ordering
2013-10-04 13:47:24 +00:00
Richard Roberts
43d56b120a
From Hmf6_unordered: getISAM2 and variables Reeliminated/Relinearized (d97dcacf186900d12003c399e7fe55e03ca34e3f)
2013-10-03 19:52:05 +00:00
Richard Roberts
0c7b2ec062
From Hmf6_unordered: Public isam2 - to be changed (10834edc1698d941be3203e8e6bea0bd4a573443)
2013-10-03 19:52:01 +00:00
Richard Roberts
bf40956592
Merged from Hmf6_unordered 970392249a8c50153f24594c9c81acb740cedd06
2013-10-03 19:51:56 +00:00
Luca Carlone
4996db5023
Fix in running incremental optimization on Kitti
2013-10-03 18:02:25 +00:00
Richard Roberts
4d31dd99f3
Hopefully fixed the mex build flags
2013-10-03 16:50:14 +00:00
Luca Carlone
a6dd4c0464
testing on kitti
2013-09-30 20:39:55 +00:00
Luca Carlone
441dcec64e
added unit test for selective relinearization
2013-09-28 21:25:08 +00:00
Luca Carlone
9ad72e9523
included rank tolerance in Smart factor constructor
2013-09-28 18:49:26 +00:00
Luca Carlone
d10ffee4d4
management of degeneracy
2013-09-28 00:49:37 +00:00
Luca Carlone
7560a1f6e3
Typo fixed
2013-09-27 16:06:36 +00:00
Luca Carlone
e10a0a0650
bool to disable selective relinearization
2013-09-26 23:09:50 +00:00
Luca Carlone
8168d4a186
commented test
2013-09-26 23:09:48 +00:00
Luca Carlone
22ccd4b4b4
update to smartFactor
2013-09-26 23:09:47 +00:00
Zsolt Kira
b04d2f1512
ICRA version of Kitti dataset processing
2013-09-26 20:36:57 +00:00
Alex Cunningham
d440901920
Fixed quoting on include paths for building the toolbox so that the toolbox builds again
2013-09-26 18:12:32 +00:00
Luca Carlone
70a448f43e
Efficient implementation of Selective Linearization
2013-09-26 15:07:56 +00:00
Luca Carlone
73e72a98bd
Selective relinearization
2013-09-26 01:06:55 +00:00
Luca Carlone
9f68c04792
Initial implementation of selective relinearization
2013-09-20 20:19:58 +00:00
Zsolt Kira
c310bafc8a
ISAM2 option, increased num poses
2013-09-14 03:10:10 +00:00
Luca Carlone
0e5069c26c
Added toy example on SmartRangeFactors
2013-09-14 00:21:10 +00:00
Chris Beall
5dc138aa09
wrap important bits of SmartRangeFactor
2013-09-13 21:00:48 +00:00
Chris Beall
14e65ce607
Matrix initialization bug fix
2013-09-13 18:26:39 +00:00
Zsolt Kira
7413b50da1
Support for running on entire kitti dataset.
...
Cleaned up prints, added gathering of statistics (# variables, triangulation failures, etc.)
2013-09-13 13:22:43 +00:00
Zsolt Kira
35327d0d56
Added incremental version using the normal Projection Factor.
...
Supports initialization both using read-in landmark poses or triangulation.
2013-09-11 14:02:41 +00:00
Zsolt Kira
a8d1072a02
Further optimization with another ~9% speed improvement.
...
Don't retriangulate on linearize if previous triangulation involved same poses
Added noalias in non-blockwise portion
Added exception handling for project() function
2013-09-10 15:15:24 +00:00
Vadim Indelman
b3d500f58c
Added optional flag_bump_up_near_zero_probs.
2013-08-29 22:43:09 +00:00
Vadim Indelman
86d21aaa05
Added optional flag_bump_up_near_zero_probs.
2013-08-29 22:42:33 +00:00
Luca Carlone
141958123a
Working version of rotation only smart factor
2013-08-28 17:37:58 +00:00
Vadim Indelman
df36ee643a
Added option to start with an M step.
2013-08-28 16:56:57 +00:00
Luca Carlone
0422b9cfef
degenerate case in smart vision factor
2013-08-28 16:07:58 +00:00
Luca Carlone
633220a9dd
degenerate case in SmartProjectionFactor
2013-08-28 16:07:56 +00:00