test-slam.cpp doesn't work. must be something wrong in slam.h
problem was identity in matrix.h. must only exist a SymmetricMatrix identity version
segfault for slam-belief. Might be allocating too much space for FORCES (12MB)
about to try switching to a malloced beliefPenalty
slam-belief FORCES crashing from line search