Added utilities for converting to pose
Added publish pose option
Updated readme
Merge pull request #4 from gareth-cross/feature/add-pose-publish

Feature/add pose publish