- Updated code for change in DDogleg and EJML
- Changed CachedSineCosine by removing -1