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

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