12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fixed Jacobian in python CustomFactorExample

release/4.3a0
ulterzlw 2022-12-07 14:53:32 +08:00 committed by GitHub
parent c29d60c410
commit 1ea6553550
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
python/gtsam/examples/CustomFactorExample.py
View File

@ -60,10 +60,10 @@ def error_odom(measurement: np.ndarray, this: gtsam.CustomFactor,
key1 = this.keys()[0] key1 = this.keys()[0]
key2 = this.keys()[1] key2 = this.keys()[1]
pos1, pos2 = values.atVector(key1), values.atVector(key2) pos1, pos2 = values.atVector(key1), values.atVector(key2)
error = measurement - (pos1 - pos2) error = (pos2 - pos1) - measurement
if jacobians is not None: if jacobians is not None:
jacobians[0] = I jacobians[0] = -I
jacobians[1] = -I jacobians[1] = I
return error return error