Cleanup cmake file
Use double precision quaternions
Additional body constants and names
Merge pull request #6 from lorrden/master

Use double precision quaternions