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

Fixed bug in ternary functions

release/4.3a0
Alex Cunningham 2010-03-06 17:27:01 +00:00
parent 294c7d806e
commit 7c3dbf164e
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
cpp/numericalDerivative.h
View File

@ -150,7 +150,7 @@ namespace gtsam {
{ {
Y hx = h(x1,x2,x3); Y hx = h(x1,x2,x3);
double factor = 1.0/(2.0*delta); double factor = 1.0/(2.0*delta);
const size_t m = dim(hx), n = dim(x1); const size_t m = dim(hx), n = dim(x2);
Vector d(n,0.0); Vector d(n,0.0);
Matrix H = zeros(m,n); Matrix H = zeros(m,n);
for (size_t j=0;j<n;j++) { for (size_t j=0;j<n;j++) {
@ -170,7 +170,7 @@ namespace gtsam {
{ {
Y hx = h(x1,x2,x3); Y hx = h(x1,x2,x3);
double factor = 1.0/(2.0*delta); double factor = 1.0/(2.0*delta);
const size_t m = dim(hx), n = dim(x1); const size_t m = dim(hx), n = dim(x3);
Vector d(n,0.0); Vector d(n,0.0);
Matrix H = zeros(m,n); Matrix H = zeros(m,n);
for (size_t j=0;j<n;j++) { for (size_t j=0;j<n;j++) {