Revert "Trimmed the branch to only the grasp_stability_msgs sub directory"

This reverts commit d4d225499210756c08ef17224c4016339f63cce1.
Rebase from 'upstream'
Trimmed the branch to only the grasp_stability_msgs sub directory