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)