Add swerve kine to odometry to simplify update calls
Add swerve kine to odometry to simplify update calls