Commit Graph

413 Commits (b51a8380c4e38f5eec4b6a696ccb0173551f9a4f)

Author SHA1 Message Date
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