velocity correction and shooter tables time

This commit is contained in:
aarav18
2022-03-12 14:05:33 -07:00
parent 89ba3afb00
commit 032e176efe
6 changed files with 119 additions and 5 deletions
@@ -163,6 +163,7 @@ public class SwerveDrive extends SubsystemBase {
updateSmartDash();
SmartDashboard.putNumber("Pigeon Yaw", m_gyro.getYaw());
SmartDashboard.putNumber("Pigeon Yaw (0 to 360)", m_gyro.getYaw() % 360);
m_field.setRobotPose(m_poseEstimator.getEstimatedPosition());
super.periodic();