Merge branch 'non-templated-version' of https://github.com/dacuda/Sophus into non-templated-version
testing subtree merge