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

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