Merge pull request #32 from florent-lamiraux/master

Add a test on distance computation between capsule and box.
more efficient vector rotation without explicitly assigning quaternions