Implement a Pose sensor

SensorPose and ProcessoPose using a new FactorPose3dWithExtrinsics will be implemented. The use case motivating this is the processing of mocap data for which the relative pose between mocap robot frame and the base robot frame is approximately known or unknown.