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

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