Cleanup cmake file
Use double precision quaternions
Additional body constants and names