- organized headers. - added comments to headers. - fixed a solver determinism bug. - removed some un-used math functions
No changes to simulation
- Fixed mesh point culling for vertically stacked points - Fixed two point capsule vs capsule normal - Fixed bug where body flags can go out of sync - Added tests - Updated benchmarks