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

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