Commit Graph

880 Commits (02524f42e7893fc7b3232f85f8077fb6c20bf45c)

Author SHA1 Message Date
dellaert 820e9553ee TestBinaryExpression friend 2014-10-11 08:17:46 +02:00
dellaert a2d2d82e0e some namespace management 2014-10-11 07:39:13 +02:00
dellaert 23485a0e71 New and consistent naming: ExecutionTrace = whole tree, CallRecord = local information left by the function. 2014-10-10 17:45:39 +02:00
dellaert 5cfe761f27 Timing multi-threaded code 2014-10-10 17:17:20 +02:00
dellaert ae93dd9869 Commented out repeated arguments 2014-10-10 13:57:37 +02:00
dellaert 58bbce482d Ternary works, same caveat 2014-10-10 13:33:13 +02:00
dellaert 406467e341 Binary works, but it's ugly and does not work for repeated types 2014-10-10 13:29:56 +02:00
dellaert 24714e48c5 Works for Unary ! 2014-10-10 12:38:26 +02:00
dellaert f8468bd596 Recursion done 2014-10-10 12:31:40 +02:00
dellaert 40fc6f5c03 Working prototype 2014-10-10 12:29:01 +02:00
dellaert dd1b931802 Successfully defined Jacobian 2014-10-10 12:03:13 +02:00
dellaert 732ff54b83 More experiments 2014-10-10 11:41:01 +02:00
dellaert 8e264f4289 Attempt at defining Trace recursively 2014-10-09 14:38:16 +02:00
dellaert 5e5457b390 Renamed entry point to startReverseAD to emphasize it is only called once 2014-10-09 13:42:43 +02:00
dellaert 563c4d214c Renamed BADFactor -> ExpressionFactor 2014-10-09 13:00:56 +02:00
dellaert 7e069191e5 Slight refactor 2014-10-09 10:58:46 +02:00
dellaert a38a0ae9e1 Some comments 2014-10-09 00:21:10 +02:00
dellaert 9ebe1e6d10 Super-speedup by specializing to 2-dimensional output (for now). Using some template magic. 2014-10-08 23:50:17 +02:00
dellaert 31c138d0d6 Profile Bin(Leaf,Un(Bin(Leaf,Leaf))) by default 2014-10-08 17:52:46 +02:00
dellaert abb92632b8 Empty derived destructors are not needed 2014-10-08 17:32:46 +02:00
dellaert 6a1bc6e242 Documentation 2014-10-08 17:28:33 +02:00
dellaert 4ac065fab4 Show explanation of timing 2014-10-08 17:27:46 +02:00
dellaert ce2dcaeb3b Tagged union, lightweight 2014-10-08 15:39:59 +02:00
dellaert 390842e1f7 Put Trace in front 2014-10-08 13:58:15 +02:00
dellaert ba9faa68b6 New Leaf/noise tests 2014-10-08 13:56:54 +02:00
dellaert d7022a21c7 More samples to average 2014-10-07 20:11:19 +02:00
dellaert c4a92acde1 Avoid argument temporaries 2014-10-07 19:35:44 +02:00
dellaert 84987aa351 Deal with Rot3 changes 2014-10-07 19:35:20 +02:00
dellaert 3c1c9c6d12 Switch to pointers - nice improvement 2014-10-07 18:11:12 +02:00
dellaert 982dc29d2f Time ternary version as well 2014-10-07 18:10:53 +02:00
dellaert e4392c0a3b JacobianTrace no longer templated 2014-10-07 16:11:55 +02:00
dellaert 83d77271d9 Ternary now fixed 2014-10-07 13:04:04 +02:00
dellaert 613cb0bb12 Binary functions now take fixed Jacobians 2014-10-07 01:01:46 +02:00
dellaert 921b79f446 No more default argument 2014-10-07 01:01:16 +02:00
dellaert 0a6fe0f0a8 No more default argument 2014-10-07 00:44:40 +02:00
Luca 7a4f307342 moved biasedGPS and GaussMarkov to unstable 2014-10-06 13:11:40 -04:00
dellaert e48b38ca21 Fixing uncalibrate (does not yet compile) 2014-10-06 15:45:26 +02:00
dellaert e5c3f4228a Some fixed size in UnaryExpression 2014-10-06 14:22:18 +02:00
dellaert 51eab1068f Time the most common SFM expression 2014-10-06 13:57:37 +02:00
dellaert 5c96b7f38d Made naming more suggestive of AD process rather than generic H1,H2... 2014-10-06 13:19:01 +02:00
dellaert 0ed96dda33 Avoid alloc and copy 2014-10-06 12:14:15 +02:00
dellaert c748fdb404 Re-did with move semantics. Dangerously imperative. 2014-10-06 12:13:52 +02:00
Sungtae An 69f74014aa add traceExecution in TernaryExpression 2014-10-05 17:40:11 -04:00
Sungtae An cc3c0fcfec add trace structure for reverse AD in TernaryExpression 2014-10-05 17:38:09 -04:00
Sungtae An 0421d05d44 add forward() in TernaryExpression 2014-10-05 17:36:53 -04:00
Sungtae An 0a7db2d252 Merge remote-tracking branch 'origin/feature/BAD' into feature/BAD 2014-10-05 16:16:19 -04:00
Sungtae An 40565564f5 TernaryExpression is added 2014-10-05 16:09:24 -04:00
dellaert 632810ff9a Now only inline add, for performance 2014-10-05 21:53:40 +02:00
dellaert 33c1d072a4 Add switch between inline add and JacobianMap as a new class. 2014-10-05 21:49:30 +02:00
dellaert 5b13306104 Split out starting the AD process vs. propagating it, is more efficient than starting with a useless identity matrix 2014-10-05 19:27:52 +02:00
dellaert ff9dd8eb8d Removed some obsolete code 2014-10-05 19:09:16 +02:00
dellaert caf742d5e1 Better names 2014-10-05 17:20:55 +02:00
dellaert 001504a432 JacobianTrace base, and avoid copying JacobianMaps. 2014-10-05 17:12:38 +02:00
dellaert 2718662467 Removed debug printing 2014-10-05 15:01:36 +02:00
dellaert fdf9c10b42 Implemented value and now testBADFactor also runs 2014-10-05 15:00:10 +02:00
dellaert 8db2cd17fc Finished constant Trace and *everything* just works!!! Amazing :-) 2014-10-05 13:41:20 +02:00
dellaert 7c19542245 Leaf Trace compiles 2014-10-05 13:37:51 +02:00
dellaert 75445307b2 Unary Trace done 2014-10-05 13:33:23 +02:00
dellaert 8e527a2251 Binary Trace compiles, runs 2014-10-05 13:27:41 +02:00
dellaert 303d37a716 Separate hierarchy 2014-10-05 11:22:14 +02:00
dellaert 6fb10a5de9 Rename, emphasizing is forward AD 2014-10-03 21:13:34 +02:00
dellaert 3f017bf51f An optimized version 2014-10-03 14:35:39 +02:00
dellaert c20b588fe0 timing, is pretty bleak for Expressions 2014-10-03 14:19:23 +02:00
dellaert a5b92f0342 MUCH simpler by just using boost::bind to turn methods into functions 2014-10-03 13:18:25 +02:00
dellaert bdf5451565 Typedefs 2014-10-03 12:52:35 +02:00
dellaert c8dd361080 Common base class BinaryExpression 2014-10-03 12:48:28 +02:00
dellaert 987b123ec9 NullaryMethodExpression and UnaryFunctionExpression, derived from UnaryExpression 2014-10-03 12:40:26 +02:00
dellaert aefad1e548 MAJOR refactor: I now use separate functions for value (only) and "augmented", for combined value-derivatives. The latter returns a new templated class, Augmented<T>. 2014-10-03 10:25:02 +02:00
dellaert da4cfe6fdc ternary test 2014-10-02 23:39:17 +02:00
dellaert 59af1c4b6d Major refactor that does not ask for derivatives when argument is constant. Also split combine into double add, added print, and moved those two statics to ExpressionNode. 2014-10-02 23:28:19 +02:00
dellaert 166396d6f6 Added tests with constant Expression 2014-10-02 23:26:59 +02:00
dellaert e7e7b3806f New test with constant argument 2014-10-02 20:28:37 +02:00
dellaert d5709facf6 Added Pose2SLAMExample 2014-10-02 20:20:00 +02:00
dellaert 8f856ceaf8 Renamed 2014-10-02 20:19:49 +02:00
dellaert df17758469 Assume H pre-allocated as usual, and *move* Jacobians to avoid allocations 2014-10-02 13:30:16 +02:00
dellaert 0800b83285 Slight efficiencies 2014-10-02 11:44:16 +02:00
dellaert bef23a2008 ExpressionExample now only uses BADFactors and yields same result as SFMExample 2014-10-02 11:21:24 +02:00
dellaert ebb091d390 BadFactor is now a functioning NoiseModelFactor 2014-10-02 11:01:39 +02:00
dellaert 3f5aa0f23e Expression version of SFMExample (in progress) 2014-10-01 14:10:54 +02:00
dellaert ce53346a9e Added Symbol versions 2014-10-01 13:12:07 +02:00
dellaert 0d94eeb480 Created expressions.h header 2014-10-01 11:25:49 +02:00
dellaert 254f8c5f75 Possible naming convention 2014-10-01 11:01:38 +02:00
dellaert a6c1ba19cc Concise version 2014-10-01 10:53:35 +02:00
dellaert d45250a989 Fixed dim 2014-10-01 10:45:57 +02:00
dellaert d935172ac5 Tightened 2014-10-01 10:43:03 +02:00
dellaert 8f6eae922a Tightened/cleaned up 2014-10-01 10:36:24 +02:00
Paul Furgale 837b2a6bc0 Fixed the member function with very ugly syntax 2014-09-30 23:13:07 +02:00
dellaert c68c2d2dac Prototype code for passing methods. Does not work (uncomment line 61) 2014-09-30 13:19:44 +02:00
dellaert ae17f8a82f Some refactoring, new static method "combine" 2014-09-30 13:00:37 +02:00
dellaert 374140abb8 Moved all BAD stuff to nonlinear 2014-09-30 12:34:03 +02:00
dellaert 1aa7b570f9 Added BADFactor header and created new test 2014-09-30 12:30:15 +02:00
dellaert ef52e12f87 Split off BADFactor code from Expression 2014-09-30 12:29:57 +02:00
dellaert 5a1ea6071b Split off ExpressionNode hierarchy 2014-09-30 12:20:02 +02:00
dellaert e2f6f01941 Some cleanup of headers/old code 2014-09-30 12:12:17 +02:00
dellaert e789de2353 Check derivatives of compose 2014-09-29 12:14:59 +02:00
dellaert 05c49601ed Added Expression header 2014-09-29 12:06:04 +02:00
Paul Furgale de3e1c3ed1 Fixed the product compilation 2014-09-29 07:22:25 +02:00
dellaert 10a35f3535 Structure for compose. Does not compile (uncomment line 492) 2014-09-28 17:50:36 +02:00
dellaert 7be6ac0e8c Now compiles but product construction fails because optional derivatives can't be delivered by the operator*() 2014-09-28 10:22:19 +02:00
dellaert 11187a4c0d I added operator logic but can't get it to compile 2014-09-27 18:22:37 +02:00
dellaert ab1f4c1e32 keys now functional 2014-09-27 16:08:59 +02:00
dellaert 186afcc95e Made constructors private 2014-09-27 15:58:34 +02:00
dellaert e487979b0f Removed obsolete typedefs 2014-09-27 15:49:25 +02:00
dellaert cde9a41acc Formatting only 2014-09-27 15:48:07 +02:00
Paul Furgale 768c7f00e1 Removed the clone method 2014-09-27 15:01:02 +02:00
dellaert 9eed7e10fe Added testBAD.run target, fixed an issue with getKeys 2014-09-27 14:08:31 +02:00
Paul Furgale 1a00d7e3d9 Second draft of the BAD implementation 2014-09-27 11:39:46 +02:00
cbeall3 e0a9eb63ce Fix for Windows: renamed some tests 2014-09-24 16:47:07 -04:00
dellaert b47837462e Unit test succeeds !!! 2014-09-21 18:54:01 +02:00
dellaert 4bc82da85c Compile with optional derivatives 2014-09-21 18:36:19 +02:00
dellaert 8e3a0f4847 Prototype [jacobians] code 2014-09-21 18:22:28 +02:00
dellaert 583c81ffea Implemented uncalibrate, value test succeeds 2014-09-21 17:59:34 +02:00
dellaert 6a5e4191a3 UnaryExpression 2014-09-21 17:43:47 +02:00
dellaert b89f65cccc BinaryExpression 2014-09-21 17:37:09 +02:00
dellaert 59b0e6a657 Progress on error 2014-09-21 17:13:25 +02:00
dellaert d9fafc1bf1 No more base class 2014-09-21 16:48:24 +02:00
dellaert 7a64e2e546 Class hierarchy 2014-09-21 16:30:30 +02:00
dellaert 6532966f62 Call JacobianFactor constructor with map 2014-09-21 13:11:55 +02:00
dellaert c7b6a9af12 Now use old-style factor to create expected value and derivatives 2014-09-21 05:33:53 -04:00
dellaert a76c27d074 Now just linearize 2014-09-18 18:33:11 -04:00
dellaert b19132e004 First version of test, with vector of Matrices 2014-09-18 17:10:39 -05:00
Jing Dong be68cc0047 add given marginals to update_noiseModel to improve speed 2014-09-15 03:03:25 -04:00
Jing Dong 1a7653730c fix headers for TransBtwRobotFactorEM 2014-09-13 18:12:28 -04:00
Vadim Indelman 6b890cec0e added updateNoiseModels functionality 2014-09-10 00:24:32 +03:00
Chris Beall 2634b2e890 Finish concurrent-calibration 2014-08-12 16:00:20 -04:00
Chris Beall 50c8313233 Rename TransformProjectionFactor to ProjectionFactorPPP 2014-08-12 15:55:28 -04:00
Chris Beall 2c3f6e563d Renamed TransformCalProjectionFactor to ProjectionFactorPPPC to follow new naming convention 2014-08-12 15:29:05 -04:00
Vadim Indelman bcab483574 Changed norm to determinant. 2014-08-01 21:51:52 +03:00
Vadim Indelman 89410fe1ee added updateNoiseModels_givenCovs to BetweenFactorEM. 2014-08-01 21:11:19 +03:00
cbeall3 bc982293ab New unit tests for quaternary pose+transform+landmark+calibration factor 2014-07-29 21:55:14 -04:00
Jing Dong b5b1bbfba0 improve TransBtwRobotEM factor's preformance by removing redundant unwhitenedError calc 2014-07-18 17:11:21 -04:00
Jing Dong e06c2cfacc change few function parameters to const reference to improve preformance of TransformBtwRobot factors 2014-07-18 15:59:14 -04:00
cbeall3 f4dc6a3a95 Fix metis linking in tests 2014-07-16 14:45:12 -04:00
cbeall3 f261a6ddbc Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration 2014-07-02 15:49:47 -04:00
cbeall3 8bc87e8f4f Transform + Calibration examples and factor 2014-07-01 16:33:23 -04:00
cbeall3 5b2f4a2c3a Move Transform factors to unstable 2014-07-01 16:03:35 -04:00
Vadim Indelman 991906181b Updating EM factor (to accout for uncertainty in states) 2014-06-30 20:43:25 +03:00
Richard Roberts 946cc5338a Merge branch 'develop' into feature/timing_scripts_build
Conflicts:
	gtsam_unstable/CMakeLists.txt
2014-06-21 08:55:49 -07:00
cbeall3 7485a8f2d5 Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration 2014-06-20 13:48:26 -04:00
cbeall3 3bacdbbec5 Move Smart Projection Factor wrapper to stable 2014-06-20 13:41:51 -04:00
cbeall3 a34dff1397 Merge remote-tracking branch 'origin/feature/new_imu_factors' into develop 2014-06-20 13:32:34 -04:00
cbeall3 67e0e71802 First script to experiment with Concurrent calibration estimation 2014-06-13 12:17:45 -04:00
cbeall3 9f796565d0 print optimization errors for now 2014-06-12 16:24:03 -04:00
cbeall3 8bee2cd70f Fixed unstable examples never getting built 2014-06-12 14:40:24 -04:00
Richard Roberts fe235b1209 Building timing scripts using new timing script support in GtsamTesting.cmake. Fixed compile errors in timing scripts but disabled a couple. 2014-06-07 19:02:11 -07:00
Richard Roberts 2591f7dca2 Fixed missing gtsam_unstable/partition tests 2014-06-07 19:01:13 -07:00
cbeall3 87f5818776 Move smart projection factor 2014-05-31 15:33:19 -04:00
cbeall3 41de41deec minor cleanup 2014-05-30 19:37:03 -04:00
cbeall3 a7a209ce0c Minor fixes and documentation cleanup 2014-05-30 13:31:35 -04:00
cbeall3 625b7b0743 Monocular Smart Projection factor example based on stereo data 2014-05-30 11:58:07 -04:00
Luca 386ed2e510 Merge branch 'develop'
Conflicts:
	gtsam_unstable/slam/SmartFactorBase.h
2014-05-28 18:11:39 -04:00
cbeall3 2699605943 Fix return type mismatch 2014-05-28 11:31:17 -04:00
Luca 8806c15b36 fixed possible connectivity issue when smart factors are degenerate 2014-05-23 17:49:42 -04:00
Luca c2705902cb added dynamic outlier rejection (with unit tests) for smart pose factors 2014-05-22 22:32:12 -04:00
Luca e0500f7b18 added and renamed unit tests 2014-05-22 21:28:00 -04:00
Luca 4f91f94d1e included possibility to linearize to Jacobian for smart Pose factors 2014-05-22 21:27:46 -04:00
djensen3 b83a996731 Fixed SmartProjectionPoseFactor matlab wrapping 2014-05-13 17:04:16 -04:00
Chris Beall 1062e41de3 shut up some warnings on Windows 2014-05-06 22:57:26 -04:00
cbeall3 842554a230 Unit test fixes for quaternion mode and also rotation matrix + full expmap mode. 2014-05-06 20:03:45 -04:00
cbeall3 0450c58d66 silence warning 2014-05-06 12:06:07 -04:00
dellaert 9373711a85 Finish TSAMFactors 2014-05-06 01:34:56 -04:00
cbeall3 2f180d1d02 Remove using namespace std from header files 2014-05-05 16:35:22 -04:00
dellaert 0a2385711b MATLAB wrapping of TSAMFactors 2014-05-05 10:14:56 -04:00
dellaert 05c1e572b6 Moved TSAMFactors.h from tsam to gtsam 2014-05-05 10:14:36 -04:00
Luca 5c420f1aec added references 2014-05-04 18:16:40 -04:00
dellaert 92c9e9c0aa Fixed "unused" warnings 2014-05-03 12:23:49 -04:00
dellaert 1ed07ca4ed Moved to unstable 2014-05-03 12:23:20 -04:00
djensen3 5402f9fa20 Removed smartProjectionPoseFactor from matlab wrapper; it was causing matlab crashes 2014-05-02 11:12:10 -04:00
djensen3 8dbd7c175c added SmartProjectionFactor to matlab wrapper 2014-05-01 15:55:37 -04:00
djensen3 ce13807d10 added script to run and save tests in a simplified way 2014-05-01 12:56:24 -04:00
Luca 32e1a8f994 tried some changes for wrapping 2014-05-01 10:48:54 -04:00
djensen3 2cb448fa24 adding SmartProjectionPoseFactor to wrapper 2014-04-30 16:17:32 -04:00
Luca 185c572b5a removed wrong base class 2014-04-24 11:28:41 -04:00
Luca 8c657f8857 slight change in implementation of hessianBlockDiagonal 2014-04-23 19:00:15 -04:00
Luca d9e93f316a error computation now does not include noise model 2014-04-23 18:43:14 -04:00
Luca 2b52bad569 optimized point damping 2014-04-23 15:15:48 -04:00
Luca e56666e85c fixed print function 2014-04-23 14:53:01 -04:00
Luca 37b750411f added gradientAtZero with raw memory access 2014-04-22 18:38:12 -04:00
Luca dd780e356c fixed computation of linearized error in implicit schur factors 2014-04-21 18:59:33 -04:00
Luca e232b6085b wrapping smart factors 2014-04-15 11:06:38 -04:00
Luca bd218feada Merge branch 'develop' 2014-04-15 10:57:20 -04:00
Luca f63db8859b addind wrapper for smart factors 2014-04-15 10:56:17 -04:00
Luca 926b4c6443 removed temporary variables - minor 2014-04-14 11:41:55 -04:00
Luca 6ef11bb297 removed debug statements 2014-04-09 21:14:38 -04:00
Luca 4bdefc3f70 removed debug bloks 2014-04-09 21:04:52 -04:00
Luca dc7b5d58c0 implemented efficient update of Hessian matrix via Schur complement 2014-04-09 21:01:03 -04:00
Luca 4123053c81 progress on grouping - still seg faults 2014-04-08 18:55:42 -04:00
Luca 2908197f1a Merge branch 'develop' 2014-04-06 14:35:32 -04:00
Luca 310fce3be9 last updates from smartFactors project (these files are now removed from that project) 2014-04-06 14:25:46 -04:00
Andrew Melim e98b90bd2a Make building of metis/partition optional via cmake flag 2014-04-04 15:49:04 -04:00
jing 02fc860d9e add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable 2014-03-27 13:14:13 -04:00
cbeall3 178b7f29da clang warnings 2014-03-17 21:56:50 -04:00
Andrew Melim 9ffc928536 Correct signed vs unsigned comparison warnings 2014-03-17 12:07:54 -04:00
Andrew Melim 719592258b Remove unused variable 2014-03-17 12:04:40 -04:00
dellaert 68297dedb5 Removed unused variable 2014-03-16 16:36:07 -04:00
Luca 6f692b1547 Merge branch 'develop'
Conflicts:
	gtsam/base/SymmetricBlockMatrix.cpp
	gtsam/linear/JacobianFactor-inl.h
	gtsam_unstable/geometry/tests/testTriangulation.cpp
2014-03-12 12:57:59 -04:00
dellaert 9007d1ca72 Copy constructor and return const & 2014-03-06 21:07:54 -05:00
dellaert 691e9884d7 Const correctness, comments, and templated Eigen blocks (esp. important in integrate) 2014-03-06 21:05:11 -05:00
dellaert f5ce1d865e A custom linearize for speed 2014-03-04 02:50:28 -05:00
dellaert b1013163e7 Switched to TriangulationFactors: huge improvement 2014-03-02 15:51:02 -05:00