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

This reverts commit ab6e1e15677cd1603b0b3816d325b93bcf1402d7.
Rebase from 'upstream'
Trimmed the branch to only the saphari_msgs sub directory