diff --git a/maven/com/ctre/phoenix/api-cpp/5.30.4/api-cpp-5.30.4.pom b/maven/com/ctre/phoenix/api-cpp/5.30.4/api-cpp-5.30.4.pom
new file mode 100644
index 00000000..5ad3fd28
--- /dev/null
+++ b/maven/com/ctre/phoenix/api-cpp/5.30.4/api-cpp-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix
+ api-cpp
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/api-cpp/maven-metadata.xml b/maven/com/ctre/phoenix/api-cpp/maven-metadata.xml
new file mode 100644
index 00000000..09983907
--- /dev/null
+++ b/maven/com/ctre/phoenix/api-cpp/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix
+ api-cpp
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233427
+
+
diff --git a/maven/com/ctre/phoenix/api-java/5.30.4/api-java-5.30.4.pom b/maven/com/ctre/phoenix/api-java/5.30.4/api-java-5.30.4.pom
new file mode 100644
index 00000000..fbced566
--- /dev/null
+++ b/maven/com/ctre/phoenix/api-java/5.30.4/api-java-5.30.4.pom
@@ -0,0 +1,8 @@
+
+
+ 4.0.0
+ com.ctre.phoenix
+ api-java
+ 5.30.4
+
diff --git a/maven/com/ctre/phoenix/api-java/maven-metadata.xml b/maven/com/ctre/phoenix/api-java/maven-metadata.xml
new file mode 100644
index 00000000..98e98d62
--- /dev/null
+++ b/maven/com/ctre/phoenix/api-java/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix
+ api-java
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/cci/5.30.4/cci-5.30.4.pom b/maven/com/ctre/phoenix/cci/5.30.4/cci-5.30.4.pom
new file mode 100644
index 00000000..cf358673
--- /dev/null
+++ b/maven/com/ctre/phoenix/cci/5.30.4/cci-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix
+ cci
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/cci/maven-metadata.xml b/maven/com/ctre/phoenix/cci/maven-metadata.xml
new file mode 100644
index 00000000..ce118eee
--- /dev/null
+++ b/maven/com/ctre/phoenix/cci/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix
+ cci
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/sim/api-cpp-sim/5.30.4/api-cpp-sim-5.30.4.pom b/maven/com/ctre/phoenix/sim/api-cpp-sim/5.30.4/api-cpp-sim-5.30.4.pom
new file mode 100644
index 00000000..6d7d3515
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/api-cpp-sim/5.30.4/api-cpp-sim-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix.sim
+ api-cpp-sim
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/sim/api-cpp-sim/maven-metadata.xml b/maven/com/ctre/phoenix/sim/api-cpp-sim/maven-metadata.xml
new file mode 100644
index 00000000..7b41ce63
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/api-cpp-sim/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix.sim
+ api-cpp-sim
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/sim/cci-sim/5.30.4/cci-sim-5.30.4.pom b/maven/com/ctre/phoenix/sim/cci-sim/5.30.4/cci-sim-5.30.4.pom
new file mode 100644
index 00000000..b472ea5a
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/cci-sim/5.30.4/cci-sim-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix.sim
+ cci-sim
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/sim/cci-sim/maven-metadata.xml b/maven/com/ctre/phoenix/sim/cci-sim/maven-metadata.xml
new file mode 100644
index 00000000..c51fa69a
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/cci-sim/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix.sim
+ cci-sim
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/5.30.4/wpiapi-cpp-sim-5.30.4.pom b/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/5.30.4/wpiapi-cpp-sim-5.30.4.pom
new file mode 100644
index 00000000..00f11fb6
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/5.30.4/wpiapi-cpp-sim-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix.sim
+ wpiapi-cpp-sim
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/maven-metadata.xml b/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/maven-metadata.xml
new file mode 100644
index 00000000..c292174a
--- /dev/null
+++ b/maven/com/ctre/phoenix/sim/wpiapi-cpp-sim/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix.sim
+ wpiapi-cpp-sim
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/wpiapi-cpp/5.30.4/wpiapi-cpp-5.30.4.pom b/maven/com/ctre/phoenix/wpiapi-cpp/5.30.4/wpiapi-cpp-5.30.4.pom
new file mode 100644
index 00000000..b2e1d59d
--- /dev/null
+++ b/maven/com/ctre/phoenix/wpiapi-cpp/5.30.4/wpiapi-cpp-5.30.4.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenix
+ wpiapi-cpp
+ 5.30.4
+ pom
+
diff --git a/maven/com/ctre/phoenix/wpiapi-cpp/maven-metadata.xml b/maven/com/ctre/phoenix/wpiapi-cpp/maven-metadata.xml
new file mode 100644
index 00000000..b911cc7c
--- /dev/null
+++ b/maven/com/ctre/phoenix/wpiapi-cpp/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix
+ wpiapi-cpp
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenix/wpiapi-java/5.30.4/wpiapi-java-5.30.4.pom b/maven/com/ctre/phoenix/wpiapi-java/5.30.4/wpiapi-java-5.30.4.pom
new file mode 100644
index 00000000..ee204cf3
--- /dev/null
+++ b/maven/com/ctre/phoenix/wpiapi-java/5.30.4/wpiapi-java-5.30.4.pom
@@ -0,0 +1,8 @@
+
+
+ 4.0.0
+ com.ctre.phoenix
+ wpiapi-java
+ 5.30.4
+
diff --git a/maven/com/ctre/phoenix/wpiapi-java/maven-metadata.xml b/maven/com/ctre/phoenix/wpiapi-java/maven-metadata.xml
new file mode 100644
index 00000000..7ae7b0c6
--- /dev/null
+++ b/maven/com/ctre/phoenix/wpiapi-java/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenix
+ wpiapi-java
+
+ 5.30.4
+
+ 5.30.4
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/api-cpp/23.0.8/api-cpp-23.0.8.pom b/maven/com/ctre/phoenixpro/api-cpp/23.0.8/api-cpp-23.0.8.pom
new file mode 100644
index 00000000..db0dfc52
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/api-cpp/23.0.8/api-cpp-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro
+ api-cpp
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/api-cpp/maven-metadata.xml b/maven/com/ctre/phoenixpro/api-cpp/maven-metadata.xml
new file mode 100644
index 00000000..50da32c3
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/api-cpp/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro
+ api-cpp
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/api-java/23.0.8/api-java-23.0.8.pom b/maven/com/ctre/phoenixpro/api-java/23.0.8/api-java-23.0.8.pom
new file mode 100644
index 00000000..48aa847e
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/api-java/23.0.8/api-java-23.0.8.pom
@@ -0,0 +1,8 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro
+ api-java
+ 23.0.8
+
diff --git a/maven/com/ctre/phoenixpro/api-java/maven-metadata.xml b/maven/com/ctre/phoenixpro/api-java/maven-metadata.xml
new file mode 100644
index 00000000..6eb53278
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/api-java/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro
+ api-java
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/api-cpp-sim/23.0.8/api-cpp-sim-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/api-cpp-sim/23.0.8/api-cpp-sim-23.0.8.pom
new file mode 100644
index 00000000..2029e8f9
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/api-cpp-sim/23.0.8/api-cpp-sim-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ api-cpp-sim
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/api-cpp-sim/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/api-cpp-sim/maven-metadata.xml
new file mode 100644
index 00000000..373eede5
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/api-cpp-sim/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ api-cpp-sim
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simCANCoder/23.0.8/simCANCoder-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simCANCoder/23.0.8/simCANCoder-23.0.8.pom
new file mode 100644
index 00000000..94ef3d13
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simCANCoder/23.0.8/simCANCoder-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simCANCoder
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simCANCoder/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simCANCoder/maven-metadata.xml
new file mode 100644
index 00000000..af5f4e0f
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simCANCoder/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simCANCoder
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simPigeonIMU/23.0.8/simPigeonIMU-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simPigeonIMU/23.0.8/simPigeonIMU-23.0.8.pom
new file mode 100644
index 00000000..03e8d973
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simPigeonIMU/23.0.8/simPigeonIMU-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simPigeonIMU
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simPigeonIMU/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simPigeonIMU/maven-metadata.xml
new file mode 100644
index 00000000..524cc15e
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simPigeonIMU/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simPigeonIMU
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProCANcoder/23.0.8/simProCANcoder-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simProCANcoder/23.0.8/simProCANcoder-23.0.8.pom
new file mode 100644
index 00000000..dd9523b6
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProCANcoder/23.0.8/simProCANcoder-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simProCANcoder
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProCANcoder/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simProCANcoder/maven-metadata.xml
new file mode 100644
index 00000000..fb01ad4a
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProCANcoder/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simProCANcoder
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProPigeon2/23.0.8/simProPigeon2-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simProPigeon2/23.0.8/simProPigeon2-23.0.8.pom
new file mode 100644
index 00000000..40ee1518
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProPigeon2/23.0.8/simProPigeon2-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simProPigeon2
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProPigeon2/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simProPigeon2/maven-metadata.xml
new file mode 100644
index 00000000..e666a545
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProPigeon2/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simProPigeon2
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProTalonFX/23.0.8/simProTalonFX-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simProTalonFX/23.0.8/simProTalonFX-23.0.8.pom
new file mode 100644
index 00000000..909c2800
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProTalonFX/23.0.8/simProTalonFX-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simProTalonFX
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simProTalonFX/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simProTalonFX/maven-metadata.xml
new file mode 100644
index 00000000..e0a12d27
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simProTalonFX/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simProTalonFX
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simTalonFX/23.0.8/simTalonFX-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simTalonFX/23.0.8/simTalonFX-23.0.8.pom
new file mode 100644
index 00000000..dda9d425
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simTalonFX/23.0.8/simTalonFX-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simTalonFX
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simTalonFX/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simTalonFX/maven-metadata.xml
new file mode 100644
index 00000000..086c6d01
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simTalonFX/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simTalonFX
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simTalonSRX/23.0.8/simTalonSRX-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simTalonSRX/23.0.8/simTalonSRX-23.0.8.pom
new file mode 100644
index 00000000..15f19b32
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simTalonSRX/23.0.8/simTalonSRX-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simTalonSRX
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simTalonSRX/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simTalonSRX/maven-metadata.xml
new file mode 100644
index 00000000..962318c8
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simTalonSRX/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simTalonSRX
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/simVictorSPX/23.0.8/simVictorSPX-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/simVictorSPX/23.0.8/simVictorSPX-23.0.8.pom
new file mode 100644
index 00000000..79be6182
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simVictorSPX/23.0.8/simVictorSPX-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ simVictorSPX
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/simVictorSPX/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/simVictorSPX/maven-metadata.xml
new file mode 100644
index 00000000..6539fc7c
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/simVictorSPX/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ simVictorSPX
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/sim/tools-sim/23.0.8/tools-sim-23.0.8.pom b/maven/com/ctre/phoenixpro/sim/tools-sim/23.0.8/tools-sim-23.0.8.pom
new file mode 100644
index 00000000..8e0a0ca6
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/tools-sim/23.0.8/tools-sim-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro.sim
+ tools-sim
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/sim/tools-sim/maven-metadata.xml b/maven/com/ctre/phoenixpro/sim/tools-sim/maven-metadata.xml
new file mode 100644
index 00000000..9b3e34ff
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/sim/tools-sim/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro.sim
+ tools-sim
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/maven/com/ctre/phoenixpro/tools/23.0.8/tools-23.0.8.pom b/maven/com/ctre/phoenixpro/tools/23.0.8/tools-23.0.8.pom
new file mode 100644
index 00000000..1bc747db
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/tools/23.0.8/tools-23.0.8.pom
@@ -0,0 +1,9 @@
+
+
+ 4.0.0
+ com.ctre.phoenixpro
+ tools
+ 23.0.8
+ pom
+
diff --git a/maven/com/ctre/phoenixpro/tools/maven-metadata.xml b/maven/com/ctre/phoenixpro/tools/maven-metadata.xml
new file mode 100644
index 00000000..9e81d29e
--- /dev/null
+++ b/maven/com/ctre/phoenixpro/tools/maven-metadata.xml
@@ -0,0 +1,12 @@
+
+
+ com.ctre.phoenixpro
+ tools
+
+ 23.0.8
+
+ 23.0.8
+
+ 20230217233428
+
+
diff --git a/src/main/java/frc/robot/subsystems/SwerveSubsystem.java b/src/main/java/frc/robot/subsystems/SwerveSubsystem.java
index 8bdd826a..1dc84cb2 100644
--- a/src/main/java/frc/robot/subsystems/SwerveSubsystem.java
+++ b/src/main/java/frc/robot/subsystems/SwerveSubsystem.java
@@ -1,12 +1,11 @@
package frc.robot.subsystems;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
-import com.kauailabs.navx.frc.AHRS;
+import com.ctre.phoenix.sensors.Pigeon2;
import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.math.kinematics.SwerveDriveKinematics;
import edu.wpi.first.math.kinematics.SwerveModuleState;
-import edu.wpi.first.wpilibj.SPI;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import frc.robot.Constants.DriveConstants;
@@ -47,7 +46,7 @@ public class SwerveSubsystem extends SubsystemBase implements AutoCloseable {
DriveConstants.kBackRightDriveAbsoluteEncoderOffsetRad,
DriveConstants.kBackRightDriveAbsoluteEncoderReversed);
- private final AHRS gyro = new AHRS(SPI.Port.kMXP);
+ private final Pigeon2 gyro = new Pigeon2(0);
public SwerveSubsystem() {
/* Threads are units of code. These threads call the zeroHeading method 1 sec
@@ -62,11 +61,11 @@ public SwerveSubsystem() {
}
public void zeroHeading() {
- gyro.reset();
+ gyro.setYaw(0);
}
public double getHeading() {
- return Math.IEEEremainder(gyro.getAngle(), 360);
+ return Math.IEEEremainder(gyro.getYaw(), 360);
}
public Rotation2d getRotation2d() {
@@ -102,6 +101,6 @@ public void close() throws Exception {
frontRight.close();
backLeft.close();
backRight.close();
- gyro.close();
+ gyro.DestroyObject();
}
}
diff --git a/vendordeps/NavX.json b/vendordeps/NavX.json
deleted file mode 100644
index 29ec93aa..00000000
--- a/vendordeps/NavX.json
+++ /dev/null
@@ -1,39 +0,0 @@
-{
- "fileName": "NavX.json",
- "name": "KauaiLabs_navX_FRC",
- "version": "2023.0.3",
- "uuid": "cb311d09-36e9-4143-a032-55bb2b94443b",
- "mavenUrls": [
- "https://dev.studica.com/maven/release/2023/"
- ],
- "jsonUrl": "https://dev.studica.com/releases/2023/NavX.json",
- "javaDependencies": [
- {
- "groupId": "com.kauailabs.navx.frc",
- "artifactId": "navx-frc-java",
- "version": "2023.0.3"
- }
- ],
- "jniDependencies": [],
- "cppDependencies": [
- {
- "groupId": "com.kauailabs.navx.frc",
- "artifactId": "navx-frc-cpp",
- "version": "2023.0.3",
- "headerClassifier": "headers",
- "sourcesClassifier": "sources",
- "sharedLibrary": false,
- "libName": "navx_frc",
- "skipInvalidPlatforms": true,
- "binaryPlatforms": [
- "linuxathena",
- "linuxraspbian",
- "linuxarm32",
- "linuxarm64",
- "linux86-64",
- "osxuniversal",
- "windowsx86-64"
- ]
- }
- ]
-}
\ No newline at end of file
diff --git a/vendordeps/Phoenix5.json b/vendordeps/Phoenix5.json
new file mode 100644
index 00000000..24c9f19c
--- /dev/null
+++ b/vendordeps/Phoenix5.json
@@ -0,0 +1,423 @@
+{
+ "fileName": "Phoenix.json",
+ "name": "CTRE-Phoenix (v5)",
+ "version": "5.30.4+23.0.8",
+ "frcYear": 2023,
+ "uuid": "ab676553-b602-441f-a38d-f1296eff6537",
+ "mavenUrls": [
+ "https://maven.ctr-electronics.com/release/"
+ ],
+ "jsonUrl": "https://maven.ctr-electronics.com/release/com/ctre/phoenix/Phoenix5-frc2023-latest.json",
+ "javaDependencies": [
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "api-java",
+ "version": "5.30.4"
+ },
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "wpiapi-java",
+ "version": "5.30.4"
+ }
+ ],
+ "jniDependencies": [
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "cci",
+ "version": "5.30.4",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix.sim",
+ "artifactId": "cci-sim",
+ "version": "5.30.4",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro",
+ "artifactId": "tools",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "tools-sim",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simTalonSRX",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simTalonFX",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simVictorSPX",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simPigeonIMU",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simCANCoder",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProTalonFX",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProCANcoder",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProPigeon2",
+ "version": "23.0.8",
+ "isJar": false,
+ "skipInvalidPlatforms": true,
+ "validPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ }
+ ],
+ "cppDependencies": [
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "wpiapi-cpp",
+ "version": "5.30.4",
+ "libName": "CTRE_Phoenix_WPI",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "api-cpp",
+ "version": "5.30.4",
+ "libName": "CTRE_Phoenix",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix",
+ "artifactId": "cci",
+ "version": "5.30.4",
+ "libName": "CTRE_PhoenixCCI",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro",
+ "artifactId": "tools",
+ "version": "23.0.8",
+ "libName": "CTRE_PhoenixTools",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "linuxathena"
+ ],
+ "simMode": "hwsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix.sim",
+ "artifactId": "wpiapi-cpp-sim",
+ "version": "5.30.4",
+ "libName": "CTRE_Phoenix_WPISim",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix.sim",
+ "artifactId": "api-cpp-sim",
+ "version": "5.30.4",
+ "libName": "CTRE_PhoenixSim",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenix.sim",
+ "artifactId": "cci-sim",
+ "version": "5.30.4",
+ "libName": "CTRE_PhoenixCCISim",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "tools-sim",
+ "version": "23.0.8",
+ "libName": "CTRE_PhoenixTools_Sim",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simTalonSRX",
+ "version": "23.0.8",
+ "libName": "CTRE_SimTalonSRX",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simTalonFX",
+ "version": "23.0.8",
+ "libName": "CTRE_SimTalonFX",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simVictorSPX",
+ "version": "23.0.8",
+ "libName": "CTRE_SimVictorSPX",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simPigeonIMU",
+ "version": "23.0.8",
+ "libName": "CTRE_SimPigeonIMU",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simCANCoder",
+ "version": "23.0.8",
+ "libName": "CTRE_SimCANCoder",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProTalonFX",
+ "version": "23.0.8",
+ "libName": "CTRE_SimProTalonFX",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProCANcoder",
+ "version": "23.0.8",
+ "libName": "CTRE_SimProCANcoder",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ },
+ {
+ "groupId": "com.ctre.phoenixpro.sim",
+ "artifactId": "simProPigeon2",
+ "version": "23.0.8",
+ "libName": "CTRE_SimProPigeon2",
+ "headerClassifier": "headers",
+ "sharedLibrary": true,
+ "skipInvalidPlatforms": true,
+ "binaryPlatforms": [
+ "windowsx86-64",
+ "linuxx86-64",
+ "osxuniversal"
+ ],
+ "simMode": "swsim"
+ }
+ ]
+}
\ No newline at end of file