Pose2ds, Pose3ds and GetTV

[hollisms]

• Updated the Pose3d method names
• Added Pose2d methods for common use for AddVisionMeasurement on odometry estimators
• Added GetTV
• Made the method names for getting the double[] poses consistent and deprecated the lower case pose methods

[bhjelstrom]

Thanks for doing this. It looks like WPILib wants radians - do you think you can update your methods to handle this? (Limelight always returns degrees)

[hollisms]

Yes. Closing this and will submit new PR.