New swerve zero

first enter test mode
then rotate wheels to zero
y on swerve control