Add tests for the new Pose class#888

Micheal Parks (micheal-parks) merged 4 commits into

mainviamrobotics/visualization:mainfrom

pose-testsviamrobotics/visualization:pose-testsCopy head branch name to clipboard