added debug launch file, added state augmentation, added jakobi concat; resulting jakobis do not pass gating test

This commit is contained in:
2019-04-24 19:36:38 +02:00
parent 1ffc4fb37f
commit 821d9d6f71
5 changed files with 215 additions and 88 deletions

View File

@ -496,7 +496,7 @@ bool Feature::initializeAnchor(
//initialize patch Size
//TODO make N size a ros parameter
int N = 3;
int N = 13;
int n = (int)(N-1)/2;
auto anchor = observations.begin();