Publish conctact state and angular error between two legs as topic
Merge pull request #139 from garaemon/publish-contact-state-as-msg

Publish conctact state and angular error between two legs as topic