Make factors work for different pose types (SE(2), SE(3) and SE_2(3))

[mitchellcohen3]

Certain factor types like AbsolutePositionFactors, RelativePoseFactor, and RelativeLandmarkFactor should be generalized to handle 2D poses as well as both cases where the state to be estimated is an extended pose rather than just a pose.