Merge pull request #2 from gareth-cross/feature/swap_quaternion

Pulled quat class out
Merge remote-tracking branch 'upstream/master'
Changes to feature/pose
Merge branch 'master' of github.com:KumarRobotics/kr_math
Added new constructor to pose