add some common accessors
Added cast to ros pose
Merging changes
Changed convention of quaternion in Pose, updated triangulate and refine to match, disambiguated a couple of things in pose
Changed convention in Pose, and updated feature. Updated documentation to match. Made p and q into private member variables, removed gtsam header