Fixed the value of the initial pose
Merge pull request #25 from open-rdc/fix-init-pose

Fixed the value of the initial pose