add a util function in for converting rodrigues to quat, with unit test
Merge branch 'master' of github.com:versatran01/kr_utils