diff --git a/README.md.bak b/README.md.bak
deleted file mode 100644
index 6c28e5c..0000000
--- a/README.md.bak
+++ /dev/null
@@ -1,24 +0,0 @@
-# Yet Another Generic Swerve Library
-* In early 2023 `swerve-lib` created by SwerveDriveSpecialties officially became unmaintained after not being updated in 2022.
-* This library aims to simplify Swerve Drive implementations while not sacrificing speed or processing power.
-
-# Features
-* When a compatible absolute encoder is given it will be used as a remote encoder for the steering motor reducing CAN messages.
-* Autogenerated shuffleboard dashboard for each module which can be updated periodically with the verbosity setting.
-* The swerve drive is configurable via JSON files, and you can initialize the entire swerve drive with a similar line as the following.
-* Simulation support.
-```java
-SwerveDrive swerveDrive = new SwerveParser(new File(Filesystem.getDeployDirectory(), "swerve")).createSwerveDrive();
-```
-
-# Library Information
-* The library is located in [swervelib/](./swervelib) with documentation in [docs/](./docs) and example JSON in [deploy](./deploy).
-
-# Check out the [Wiki](https://github.com/BroncBotz3481/YAGSL/wiki)
-# Java docs is [here](https://broncbotz3481.github.io/YAGSL/).
-
-# Images
-
-
-
-
diff --git a/docs/allclasses-index.html b/docs/allclasses-index.html
index faef0d7..e649b76 100644
--- a/docs/allclasses-index.html
+++ b/docs/allclasses-index.html
@@ -1,7 +1,7 @@
-
+
All Classes and Interfaces
diff --git a/docs/allpackages-index.html b/docs/allpackages-index.html
index 2026fd4..1f0c307 100644
--- a/docs/allpackages-index.html
+++ b/docs/allpackages-index.html
@@ -1,7 +1,7 @@
-
+
All Packages
diff --git a/docs/constant-values.html b/docs/constant-values.html
index 1f7598d..5107341 100644
--- a/docs/constant-values.html
+++ b/docs/constant-values.html
@@ -1,7 +1,7 @@
-
+
Constant Field Values
diff --git a/docs/help-doc.html b/docs/help-doc.html
index 01b5e9e..e00e8c6 100644
--- a/docs/help-doc.html
+++ b/docs/help-doc.html
@@ -1,7 +1,7 @@
-
+
API Help
diff --git a/docs/index-files/index-1.html b/docs/index-files/index-1.html
index 0473e99..8f6ba79 100644
--- a/docs/index-files/index-1.html
+++ b/docs/index-files/index-1.html
@@ -1,7 +1,7 @@
-
+
A-Index
diff --git a/docs/index-files/index-10.html b/docs/index-files/index-10.html
index 2c0ff7a..566a6a5 100644
--- a/docs/index-files/index-10.html
+++ b/docs/index-files/index-10.html
@@ -1,7 +1,7 @@
-
+
K-Index
diff --git a/docs/index-files/index-11.html b/docs/index-files/index-11.html
index cddee7e..3c1ac81 100644
--- a/docs/index-files/index-11.html
+++ b/docs/index-files/index-11.html
@@ -1,7 +1,7 @@
-
+
L-Index
diff --git a/docs/index-files/index-12.html b/docs/index-files/index-12.html
index 58d55c3..b3beece 100644
--- a/docs/index-files/index-12.html
+++ b/docs/index-files/index-12.html
@@ -1,7 +1,7 @@
-
+
M-Index
diff --git a/docs/index-files/index-13.html b/docs/index-files/index-13.html
index cec1ca2..9b03ea1 100644
--- a/docs/index-files/index-13.html
+++ b/docs/index-files/index-13.html
@@ -1,7 +1,7 @@
-
+
N-Index
diff --git a/docs/index-files/index-14.html b/docs/index-files/index-14.html
index 92eab14..3478045 100644
--- a/docs/index-files/index-14.html
+++ b/docs/index-files/index-14.html
@@ -1,7 +1,7 @@
-
+
O-Index
diff --git a/docs/index-files/index-15.html b/docs/index-files/index-15.html
index 4aaacf6..d26d0bb 100644
--- a/docs/index-files/index-15.html
+++ b/docs/index-files/index-15.html
@@ -1,7 +1,7 @@
-
+
P-Index
diff --git a/docs/index-files/index-16.html b/docs/index-files/index-16.html
index e7f6198..9641678 100644
--- a/docs/index-files/index-16.html
+++ b/docs/index-files/index-16.html
@@ -1,7 +1,7 @@
-
+
R-Index
diff --git a/docs/index-files/index-17.html b/docs/index-files/index-17.html
index a974767..76f1cab 100644
--- a/docs/index-files/index-17.html
+++ b/docs/index-files/index-17.html
@@ -1,7 +1,7 @@
-
+
S-Index
diff --git a/docs/index-files/index-18.html b/docs/index-files/index-18.html
index a86b1d7..abad755 100644
--- a/docs/index-files/index-18.html
+++ b/docs/index-files/index-18.html
@@ -1,7 +1,7 @@
-
+
T-Index
diff --git a/docs/index-files/index-19.html b/docs/index-files/index-19.html
index 7e5179b..be53295 100644
--- a/docs/index-files/index-19.html
+++ b/docs/index-files/index-19.html
@@ -1,7 +1,7 @@
-
+
U-Index
diff --git a/docs/index-files/index-2.html b/docs/index-files/index-2.html
index cde76db..8e55b98 100644
--- a/docs/index-files/index-2.html
+++ b/docs/index-files/index-2.html
@@ -1,7 +1,7 @@
-
+
B-Index
diff --git a/docs/index-files/index-20.html b/docs/index-files/index-20.html
index 0998ea3..3110295 100644
--- a/docs/index-files/index-20.html
+++ b/docs/index-files/index-20.html
@@ -1,7 +1,7 @@
-
+
V-Index
diff --git a/docs/index-files/index-21.html b/docs/index-files/index-21.html
index b11b212..43d3b32 100644
--- a/docs/index-files/index-21.html
+++ b/docs/index-files/index-21.html
@@ -1,7 +1,7 @@
-
+
W-Index
diff --git a/docs/index-files/index-22.html b/docs/index-files/index-22.html
index e9635f9..784278b 100644
--- a/docs/index-files/index-22.html
+++ b/docs/index-files/index-22.html
@@ -1,7 +1,7 @@
-
+
X-Index
diff --git a/docs/index-files/index-23.html b/docs/index-files/index-23.html
index 8d4e5e8..04e2faa 100644
--- a/docs/index-files/index-23.html
+++ b/docs/index-files/index-23.html
@@ -1,7 +1,7 @@
-
+
Y-Index
diff --git a/docs/index-files/index-24.html b/docs/index-files/index-24.html
index 9d988fe..55a83f3 100644
--- a/docs/index-files/index-24.html
+++ b/docs/index-files/index-24.html
@@ -1,7 +1,7 @@
-
+
Z-Index
diff --git a/docs/index-files/index-25.html b/docs/index-files/index-25.html
index 0e552a6..6588dbf 100644
--- a/docs/index-files/index-25.html
+++ b/docs/index-files/index-25.html
@@ -1,7 +1,7 @@
-
+
_-Index
diff --git a/docs/index-files/index-3.html b/docs/index-files/index-3.html
index b34030d..2d8a2f0 100644
--- a/docs/index-files/index-3.html
+++ b/docs/index-files/index-3.html
@@ -1,7 +1,7 @@
-
+
C-Index
diff --git a/docs/index-files/index-4.html b/docs/index-files/index-4.html
index 16b02ae..0e33e7e 100644
--- a/docs/index-files/index-4.html
+++ b/docs/index-files/index-4.html
@@ -1,7 +1,7 @@
-
+
D-Index
diff --git a/docs/index-files/index-5.html b/docs/index-files/index-5.html
index 9fe5529..42d09f9 100644
--- a/docs/index-files/index-5.html
+++ b/docs/index-files/index-5.html
@@ -1,7 +1,7 @@
-
+
E-Index
diff --git a/docs/index-files/index-6.html b/docs/index-files/index-6.html
index d132be9..8cf7d33 100644
--- a/docs/index-files/index-6.html
+++ b/docs/index-files/index-6.html
@@ -1,7 +1,7 @@
-
+
F-Index
diff --git a/docs/index-files/index-7.html b/docs/index-files/index-7.html
index 3a34cd0..8807eae 100644
--- a/docs/index-files/index-7.html
+++ b/docs/index-files/index-7.html
@@ -1,7 +1,7 @@
-
+
G-Index
diff --git a/docs/index-files/index-8.html b/docs/index-files/index-8.html
index 9889bb0..9775dad 100644
--- a/docs/index-files/index-8.html
+++ b/docs/index-files/index-8.html
@@ -1,7 +1,7 @@
-
+
H-Index
diff --git a/docs/index-files/index-9.html b/docs/index-files/index-9.html
index 509e116..ecb88db 100644
--- a/docs/index-files/index-9.html
+++ b/docs/index-files/index-9.html
@@ -1,7 +1,7 @@
-
+
I-Index
diff --git a/docs/index.html b/docs/index.html
index c3e6b52..2fd6c6e 100644
--- a/docs/index.html
+++ b/docs/index.html
@@ -1,7 +1,7 @@
-
+
Overview
diff --git a/docs/overview-summary.html b/docs/overview-summary.html
index 3b128a6..ac52d7f 100644
--- a/docs/overview-summary.html
+++ b/docs/overview-summary.html
@@ -1,7 +1,7 @@
-
+
Generated Documentation (Untitled)
diff --git a/docs/overview-tree.html b/docs/overview-tree.html
index 7d909f6..bd716d3 100644
--- a/docs/overview-tree.html
+++ b/docs/overview-tree.html
@@ -1,7 +1,7 @@
-
+
Class Hierarchy
diff --git a/docs/swervelib/SwerveController.html b/docs/swervelib/SwerveController.html
index f3e876d..b303ca4 100644
--- a/docs/swervelib/SwerveController.html
+++ b/docs/swervelib/SwerveController.html
@@ -1,7 +1,7 @@
-
+
SwerveController
diff --git a/docs/swervelib/SwerveDrive.html b/docs/swervelib/SwerveDrive.html
index 006073d..79022ec 100644
--- a/docs/swervelib/SwerveDrive.html
+++ b/docs/swervelib/SwerveDrive.html
@@ -1,7 +1,7 @@
-
+
SwerveDrive
diff --git a/docs/swervelib/SwerveModule.html b/docs/swervelib/SwerveModule.html
index ca54666..1a9a60e 100644
--- a/docs/swervelib/SwerveModule.html
+++ b/docs/swervelib/SwerveModule.html
@@ -1,7 +1,7 @@
-
+
SwerveModule
diff --git a/docs/swervelib/encoders/AnalogAbsoluteEncoderSwerve.html b/docs/swervelib/encoders/AnalogAbsoluteEncoderSwerve.html
index 7aa2887..821cb4a 100644
--- a/docs/swervelib/encoders/AnalogAbsoluteEncoderSwerve.html
+++ b/docs/swervelib/encoders/AnalogAbsoluteEncoderSwerve.html
@@ -1,7 +1,7 @@
-
+
AnalogAbsoluteEncoderSwerve
diff --git a/docs/swervelib/encoders/CANCoderSwerve.html b/docs/swervelib/encoders/CANCoderSwerve.html
index 6784423..db6a1c8 100644
--- a/docs/swervelib/encoders/CANCoderSwerve.html
+++ b/docs/swervelib/encoders/CANCoderSwerve.html
@@ -1,7 +1,7 @@
-
+
CANCoderSwerve
diff --git a/docs/swervelib/encoders/SparkMaxEncoderSwerve.html b/docs/swervelib/encoders/SparkMaxEncoderSwerve.html
index aab6f86..d075056 100644
--- a/docs/swervelib/encoders/SparkMaxEncoderSwerve.html
+++ b/docs/swervelib/encoders/SparkMaxEncoderSwerve.html
@@ -1,7 +1,7 @@
-
+
SparkMaxEncoderSwerve
diff --git a/docs/swervelib/encoders/SwerveAbsoluteEncoder.html b/docs/swervelib/encoders/SwerveAbsoluteEncoder.html
index 39bd50f..fe94931 100644
--- a/docs/swervelib/encoders/SwerveAbsoluteEncoder.html
+++ b/docs/swervelib/encoders/SwerveAbsoluteEncoder.html
@@ -1,7 +1,7 @@
-
+
SwerveAbsoluteEncoder
diff --git a/docs/swervelib/encoders/package-summary.html b/docs/swervelib/encoders/package-summary.html
index 959e5cd..87e0cd9 100644
--- a/docs/swervelib/encoders/package-summary.html
+++ b/docs/swervelib/encoders/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.encoders
diff --git a/docs/swervelib/encoders/package-tree.html b/docs/swervelib/encoders/package-tree.html
index a57a274..e325572 100644
--- a/docs/swervelib/encoders/package-tree.html
+++ b/docs/swervelib/encoders/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.encoders Class Hierarchy
diff --git a/docs/swervelib/imu/ADIS16448Swerve.html b/docs/swervelib/imu/ADIS16448Swerve.html
index 887c967..bdc443b 100644
--- a/docs/swervelib/imu/ADIS16448Swerve.html
+++ b/docs/swervelib/imu/ADIS16448Swerve.html
@@ -1,7 +1,7 @@
-
+
ADIS16448Swerve
diff --git a/docs/swervelib/imu/ADIS16470Swerve.html b/docs/swervelib/imu/ADIS16470Swerve.html
index 8fd8ab5..80a2942 100644
--- a/docs/swervelib/imu/ADIS16470Swerve.html
+++ b/docs/swervelib/imu/ADIS16470Swerve.html
@@ -1,7 +1,7 @@
-
+
ADIS16470Swerve
diff --git a/docs/swervelib/imu/ADXRS450Swerve.html b/docs/swervelib/imu/ADXRS450Swerve.html
index 760636d..5174e6a 100644
--- a/docs/swervelib/imu/ADXRS450Swerve.html
+++ b/docs/swervelib/imu/ADXRS450Swerve.html
@@ -1,7 +1,7 @@
-
+
ADXRS450Swerve
diff --git a/docs/swervelib/imu/AnalogGyroSwerve.html b/docs/swervelib/imu/AnalogGyroSwerve.html
index 7e4e94d..546b66e 100644
--- a/docs/swervelib/imu/AnalogGyroSwerve.html
+++ b/docs/swervelib/imu/AnalogGyroSwerve.html
@@ -1,7 +1,7 @@
-
+
AnalogGyroSwerve
diff --git a/docs/swervelib/imu/NavXSwerve.html b/docs/swervelib/imu/NavXSwerve.html
index af7a8a9..2576574 100644
--- a/docs/swervelib/imu/NavXSwerve.html
+++ b/docs/swervelib/imu/NavXSwerve.html
@@ -1,7 +1,7 @@
-
+
NavXSwerve
diff --git a/docs/swervelib/imu/Pigeon2Swerve.html b/docs/swervelib/imu/Pigeon2Swerve.html
index 6ec7db3..e36dd50 100644
--- a/docs/swervelib/imu/Pigeon2Swerve.html
+++ b/docs/swervelib/imu/Pigeon2Swerve.html
@@ -1,7 +1,7 @@
-
+
Pigeon2Swerve
diff --git a/docs/swervelib/imu/PigeonSwerve.html b/docs/swervelib/imu/PigeonSwerve.html
index f2147ac..e36a7ed 100644
--- a/docs/swervelib/imu/PigeonSwerve.html
+++ b/docs/swervelib/imu/PigeonSwerve.html
@@ -1,7 +1,7 @@
-
+
PigeonSwerve
diff --git a/docs/swervelib/imu/SwerveIMU.html b/docs/swervelib/imu/SwerveIMU.html
index fd966d5..808d004 100644
--- a/docs/swervelib/imu/SwerveIMU.html
+++ b/docs/swervelib/imu/SwerveIMU.html
@@ -1,7 +1,7 @@
-
+
SwerveIMU
diff --git a/docs/swervelib/imu/package-summary.html b/docs/swervelib/imu/package-summary.html
index 253164d..91e58c3 100644
--- a/docs/swervelib/imu/package-summary.html
+++ b/docs/swervelib/imu/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.imu
diff --git a/docs/swervelib/imu/package-tree.html b/docs/swervelib/imu/package-tree.html
index 607a407..e22146f 100644
--- a/docs/swervelib/imu/package-tree.html
+++ b/docs/swervelib/imu/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.imu Class Hierarchy
diff --git a/docs/swervelib/math/Matter.html b/docs/swervelib/math/Matter.html
index c9c2083..394f9ec 100644
--- a/docs/swervelib/math/Matter.html
+++ b/docs/swervelib/math/Matter.html
@@ -1,7 +1,7 @@
-
+
Matter
diff --git a/docs/swervelib/math/SwerveKinematics2.html b/docs/swervelib/math/SwerveKinematics2.html
index fcaef0c..e84481d 100644
--- a/docs/swervelib/math/SwerveKinematics2.html
+++ b/docs/swervelib/math/SwerveKinematics2.html
@@ -1,7 +1,7 @@
-
+
SwerveKinematics2
diff --git a/docs/swervelib/math/SwerveMath.html b/docs/swervelib/math/SwerveMath.html
index 425e2fd..2089230 100644
--- a/docs/swervelib/math/SwerveMath.html
+++ b/docs/swervelib/math/SwerveMath.html
@@ -1,7 +1,7 @@
-
+
SwerveMath
diff --git a/docs/swervelib/math/SwerveModuleState2.html b/docs/swervelib/math/SwerveModuleState2.html
index 2a2cb9a..2d5cc52 100644
--- a/docs/swervelib/math/SwerveModuleState2.html
+++ b/docs/swervelib/math/SwerveModuleState2.html
@@ -1,7 +1,7 @@
-
+
SwerveModuleState2
diff --git a/docs/swervelib/math/package-summary.html b/docs/swervelib/math/package-summary.html
index 41a543c..3149043 100644
--- a/docs/swervelib/math/package-summary.html
+++ b/docs/swervelib/math/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.math
diff --git a/docs/swervelib/math/package-tree.html b/docs/swervelib/math/package-tree.html
index 76dae74..cc0aa22 100644
--- a/docs/swervelib/math/package-tree.html
+++ b/docs/swervelib/math/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.math Class Hierarchy
diff --git a/docs/swervelib/motors/SparkMaxBrushedMotorSwerve.html b/docs/swervelib/motors/SparkMaxBrushedMotorSwerve.html
index 6218291..5d23b94 100644
--- a/docs/swervelib/motors/SparkMaxBrushedMotorSwerve.html
+++ b/docs/swervelib/motors/SparkMaxBrushedMotorSwerve.html
@@ -1,7 +1,7 @@
-
+
SparkMaxBrushedMotorSwerve
diff --git a/docs/swervelib/motors/SparkMaxSwerve.SparkMAX_slotIdx.html b/docs/swervelib/motors/SparkMaxSwerve.SparkMAX_slotIdx.html
index 36e251d..c3691b5 100644
--- a/docs/swervelib/motors/SparkMaxSwerve.SparkMAX_slotIdx.html
+++ b/docs/swervelib/motors/SparkMaxSwerve.SparkMAX_slotIdx.html
@@ -1,7 +1,7 @@
-
+
SparkMaxSwerve.SparkMAX_slotIdx
diff --git a/docs/swervelib/motors/SparkMaxSwerve.html b/docs/swervelib/motors/SparkMaxSwerve.html
index e07b3e8..a345321 100644
--- a/docs/swervelib/motors/SparkMaxSwerve.html
+++ b/docs/swervelib/motors/SparkMaxSwerve.html
@@ -1,7 +1,7 @@
-
+
SparkMaxSwerve
diff --git a/docs/swervelib/motors/SwerveMotor.html b/docs/swervelib/motors/SwerveMotor.html
index 640c6cb..f0d8dd1 100644
--- a/docs/swervelib/motors/SwerveMotor.html
+++ b/docs/swervelib/motors/SwerveMotor.html
@@ -1,7 +1,7 @@
-
+
SwerveMotor
diff --git a/docs/swervelib/motors/TalonFXSwerve.html b/docs/swervelib/motors/TalonFXSwerve.html
index b855e84..c231ce6 100644
--- a/docs/swervelib/motors/TalonFXSwerve.html
+++ b/docs/swervelib/motors/TalonFXSwerve.html
@@ -1,7 +1,7 @@
-
+
TalonFXSwerve
diff --git a/docs/swervelib/motors/TalonSRXSwerve.html b/docs/swervelib/motors/TalonSRXSwerve.html
index f16d991..496dd45 100644
--- a/docs/swervelib/motors/TalonSRXSwerve.html
+++ b/docs/swervelib/motors/TalonSRXSwerve.html
@@ -1,7 +1,7 @@
-
+
TalonSRXSwerve
diff --git a/docs/swervelib/motors/package-summary.html b/docs/swervelib/motors/package-summary.html
index f1a924d..9968769 100644
--- a/docs/swervelib/motors/package-summary.html
+++ b/docs/swervelib/motors/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.motors
diff --git a/docs/swervelib/motors/package-tree.html b/docs/swervelib/motors/package-tree.html
index fc27502..ed76945 100644
--- a/docs/swervelib/motors/package-tree.html
+++ b/docs/swervelib/motors/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.motors Class Hierarchy
diff --git a/docs/swervelib/package-summary.html b/docs/swervelib/package-summary.html
index 973f64f..a2ce391 100644
--- a/docs/swervelib/package-summary.html
+++ b/docs/swervelib/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib
diff --git a/docs/swervelib/package-tree.html b/docs/swervelib/package-tree.html
index e6ab312..f25aeda 100644
--- a/docs/swervelib/package-tree.html
+++ b/docs/swervelib/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib Class Hierarchy
diff --git a/docs/swervelib/parser/PIDFConfig.html b/docs/swervelib/parser/PIDFConfig.html
index 9fb8387..52c91c9 100644
--- a/docs/swervelib/parser/PIDFConfig.html
+++ b/docs/swervelib/parser/PIDFConfig.html
@@ -1,7 +1,7 @@
-
+
PIDFConfig
diff --git a/docs/swervelib/parser/SwerveControllerConfiguration.html b/docs/swervelib/parser/SwerveControllerConfiguration.html
index 48be576..5cba1a5 100644
--- a/docs/swervelib/parser/SwerveControllerConfiguration.html
+++ b/docs/swervelib/parser/SwerveControllerConfiguration.html
@@ -1,7 +1,7 @@
-
+
SwerveControllerConfiguration
diff --git a/docs/swervelib/parser/SwerveDriveConfiguration.html b/docs/swervelib/parser/SwerveDriveConfiguration.html
index 1e67168..6b8d7dd 100644
--- a/docs/swervelib/parser/SwerveDriveConfiguration.html
+++ b/docs/swervelib/parser/SwerveDriveConfiguration.html
@@ -1,7 +1,7 @@
-
+
SwerveDriveConfiguration
diff --git a/docs/swervelib/parser/SwerveModuleConfiguration.html b/docs/swervelib/parser/SwerveModuleConfiguration.html
index 0711306..0c2d939 100644
--- a/docs/swervelib/parser/SwerveModuleConfiguration.html
+++ b/docs/swervelib/parser/SwerveModuleConfiguration.html
@@ -1,7 +1,7 @@
-
+
SwerveModuleConfiguration
diff --git a/docs/swervelib/parser/SwerveModulePhysicalCharacteristics.html b/docs/swervelib/parser/SwerveModulePhysicalCharacteristics.html
index 36bbbff..921c6f8 100644
--- a/docs/swervelib/parser/SwerveModulePhysicalCharacteristics.html
+++ b/docs/swervelib/parser/SwerveModulePhysicalCharacteristics.html
@@ -1,7 +1,7 @@
-
+
SwerveModulePhysicalCharacteristics
diff --git a/docs/swervelib/parser/SwerveParser.html b/docs/swervelib/parser/SwerveParser.html
index f49ae9c..72e0d81 100644
--- a/docs/swervelib/parser/SwerveParser.html
+++ b/docs/swervelib/parser/SwerveParser.html
@@ -1,7 +1,7 @@
-
+
SwerveParser
diff --git a/docs/swervelib/parser/deserializer/PIDFRange.html b/docs/swervelib/parser/deserializer/PIDFRange.html
index 14f6763..64f5efc 100644
--- a/docs/swervelib/parser/deserializer/PIDFRange.html
+++ b/docs/swervelib/parser/deserializer/PIDFRange.html
@@ -1,7 +1,7 @@
-
+
PIDFRange
diff --git a/docs/swervelib/parser/deserializer/package-summary.html b/docs/swervelib/parser/deserializer/package-summary.html
index 2eb08fa..09b0630 100644
--- a/docs/swervelib/parser/deserializer/package-summary.html
+++ b/docs/swervelib/parser/deserializer/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.deserializer
diff --git a/docs/swervelib/parser/deserializer/package-tree.html b/docs/swervelib/parser/deserializer/package-tree.html
index 997078e..5c0eab4 100644
--- a/docs/swervelib/parser/deserializer/package-tree.html
+++ b/docs/swervelib/parser/deserializer/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.deserializer Class Hierarchy
diff --git a/docs/swervelib/parser/json/ControllerPropertiesJson.html b/docs/swervelib/parser/json/ControllerPropertiesJson.html
index d008de9..c5b16a8 100644
--- a/docs/swervelib/parser/json/ControllerPropertiesJson.html
+++ b/docs/swervelib/parser/json/ControllerPropertiesJson.html
@@ -1,7 +1,7 @@
-
+
ControllerPropertiesJson
diff --git a/docs/swervelib/parser/json/DeviceJson.html b/docs/swervelib/parser/json/DeviceJson.html
index 7929e5b..65f2ff8 100644
--- a/docs/swervelib/parser/json/DeviceJson.html
+++ b/docs/swervelib/parser/json/DeviceJson.html
@@ -1,7 +1,7 @@
-
+
DeviceJson
diff --git a/docs/swervelib/parser/json/ModuleJson.html b/docs/swervelib/parser/json/ModuleJson.html
index 3f5e88e..ea95110 100644
--- a/docs/swervelib/parser/json/ModuleJson.html
+++ b/docs/swervelib/parser/json/ModuleJson.html
@@ -1,7 +1,7 @@
-
+
ModuleJson
diff --git a/docs/swervelib/parser/json/MotorConfigDouble.html b/docs/swervelib/parser/json/MotorConfigDouble.html
index 88632ed..7797545 100644
--- a/docs/swervelib/parser/json/MotorConfigDouble.html
+++ b/docs/swervelib/parser/json/MotorConfigDouble.html
@@ -1,7 +1,7 @@
-
+
MotorConfigDouble
diff --git a/docs/swervelib/parser/json/MotorConfigInt.html b/docs/swervelib/parser/json/MotorConfigInt.html
index 8eb0a0b..0892abf 100644
--- a/docs/swervelib/parser/json/MotorConfigInt.html
+++ b/docs/swervelib/parser/json/MotorConfigInt.html
@@ -1,7 +1,7 @@
-
+
MotorConfigInt
diff --git a/docs/swervelib/parser/json/PIDFPropertiesJson.html b/docs/swervelib/parser/json/PIDFPropertiesJson.html
index abf8747..e564d98 100644
--- a/docs/swervelib/parser/json/PIDFPropertiesJson.html
+++ b/docs/swervelib/parser/json/PIDFPropertiesJson.html
@@ -1,7 +1,7 @@
-
+
PIDFPropertiesJson
diff --git a/docs/swervelib/parser/json/PhysicalPropertiesJson.html b/docs/swervelib/parser/json/PhysicalPropertiesJson.html
index 35bcfd5..43ee60e 100644
--- a/docs/swervelib/parser/json/PhysicalPropertiesJson.html
+++ b/docs/swervelib/parser/json/PhysicalPropertiesJson.html
@@ -1,7 +1,7 @@
-
+
PhysicalPropertiesJson
diff --git a/docs/swervelib/parser/json/SwerveDriveJson.html b/docs/swervelib/parser/json/SwerveDriveJson.html
index 58a4688..3affd60 100644
--- a/docs/swervelib/parser/json/SwerveDriveJson.html
+++ b/docs/swervelib/parser/json/SwerveDriveJson.html
@@ -1,7 +1,7 @@
-
+
SwerveDriveJson
diff --git a/docs/swervelib/parser/json/modules/BoolMotorJson.html b/docs/swervelib/parser/json/modules/BoolMotorJson.html
index 9079178..66e26a4 100644
--- a/docs/swervelib/parser/json/modules/BoolMotorJson.html
+++ b/docs/swervelib/parser/json/modules/BoolMotorJson.html
@@ -1,7 +1,7 @@
-
+
BoolMotorJson
diff --git a/docs/swervelib/parser/json/modules/LocationJson.html b/docs/swervelib/parser/json/modules/LocationJson.html
index c5fecd8..1eba0ef 100644
--- a/docs/swervelib/parser/json/modules/LocationJson.html
+++ b/docs/swervelib/parser/json/modules/LocationJson.html
@@ -1,7 +1,7 @@
-
+
LocationJson
diff --git a/docs/swervelib/parser/json/modules/package-summary.html b/docs/swervelib/parser/json/modules/package-summary.html
index dcca564..8849660 100644
--- a/docs/swervelib/parser/json/modules/package-summary.html
+++ b/docs/swervelib/parser/json/modules/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.json.modules
diff --git a/docs/swervelib/parser/json/modules/package-tree.html b/docs/swervelib/parser/json/modules/package-tree.html
index fed5886..d93dcb4 100644
--- a/docs/swervelib/parser/json/modules/package-tree.html
+++ b/docs/swervelib/parser/json/modules/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.json.modules Class Hierarchy
diff --git a/docs/swervelib/parser/json/package-summary.html b/docs/swervelib/parser/json/package-summary.html
index 3f3f76c..ddce40e 100644
--- a/docs/swervelib/parser/json/package-summary.html
+++ b/docs/swervelib/parser/json/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.json
diff --git a/docs/swervelib/parser/json/package-tree.html b/docs/swervelib/parser/json/package-tree.html
index ab18284..c0cb89b 100644
--- a/docs/swervelib/parser/json/package-tree.html
+++ b/docs/swervelib/parser/json/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser.json Class Hierarchy
diff --git a/docs/swervelib/parser/package-summary.html b/docs/swervelib/parser/package-summary.html
index b0c7de0..2acd428 100644
--- a/docs/swervelib/parser/package-summary.html
+++ b/docs/swervelib/parser/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser
diff --git a/docs/swervelib/parser/package-tree.html b/docs/swervelib/parser/package-tree.html
index a030596..d49e5a0 100644
--- a/docs/swervelib/parser/package-tree.html
+++ b/docs/swervelib/parser/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.parser Class Hierarchy
diff --git a/docs/swervelib/simulation/SwerveIMUSimulation.html b/docs/swervelib/simulation/SwerveIMUSimulation.html
index 9951345..0bf9042 100644
--- a/docs/swervelib/simulation/SwerveIMUSimulation.html
+++ b/docs/swervelib/simulation/SwerveIMUSimulation.html
@@ -1,7 +1,7 @@
-
+
SwerveIMUSimulation
diff --git a/docs/swervelib/simulation/SwerveModuleSimulation.html b/docs/swervelib/simulation/SwerveModuleSimulation.html
index ac7a81c..1cad476 100644
--- a/docs/swervelib/simulation/SwerveModuleSimulation.html
+++ b/docs/swervelib/simulation/SwerveModuleSimulation.html
@@ -1,7 +1,7 @@
-
+
SwerveModuleSimulation
diff --git a/docs/swervelib/simulation/ctre/PhysicsSim.SimProfile.html b/docs/swervelib/simulation/ctre/PhysicsSim.SimProfile.html
index dbb9e72..ac4726b 100644
--- a/docs/swervelib/simulation/ctre/PhysicsSim.SimProfile.html
+++ b/docs/swervelib/simulation/ctre/PhysicsSim.SimProfile.html
@@ -1,7 +1,7 @@
-
+
PhysicsSim.SimProfile
diff --git a/docs/swervelib/simulation/ctre/PhysicsSim.html b/docs/swervelib/simulation/ctre/PhysicsSim.html
index 301bc28..e84f47a 100644
--- a/docs/swervelib/simulation/ctre/PhysicsSim.html
+++ b/docs/swervelib/simulation/ctre/PhysicsSim.html
@@ -1,7 +1,7 @@
-
+
PhysicsSim
diff --git a/docs/swervelib/simulation/ctre/TalonFXSimProfile.html b/docs/swervelib/simulation/ctre/TalonFXSimProfile.html
index 4358734..1431fc6 100644
--- a/docs/swervelib/simulation/ctre/TalonFXSimProfile.html
+++ b/docs/swervelib/simulation/ctre/TalonFXSimProfile.html
@@ -1,7 +1,7 @@
-
+
TalonFXSimProfile
diff --git a/docs/swervelib/simulation/ctre/TalonSRXSimProfile.html b/docs/swervelib/simulation/ctre/TalonSRXSimProfile.html
index cbc5994..0570fa6 100644
--- a/docs/swervelib/simulation/ctre/TalonSRXSimProfile.html
+++ b/docs/swervelib/simulation/ctre/TalonSRXSimProfile.html
@@ -1,7 +1,7 @@
-
+
TalonSRXSimProfile
diff --git a/docs/swervelib/simulation/ctre/VictorSPXSimProfile.html b/docs/swervelib/simulation/ctre/VictorSPXSimProfile.html
index a372035..77c6bcd 100644
--- a/docs/swervelib/simulation/ctre/VictorSPXSimProfile.html
+++ b/docs/swervelib/simulation/ctre/VictorSPXSimProfile.html
@@ -1,7 +1,7 @@
-
+
VictorSPXSimProfile
diff --git a/docs/swervelib/simulation/ctre/package-summary.html b/docs/swervelib/simulation/ctre/package-summary.html
index bf8de92..3a3c285 100644
--- a/docs/swervelib/simulation/ctre/package-summary.html
+++ b/docs/swervelib/simulation/ctre/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.simulation.ctre
diff --git a/docs/swervelib/simulation/ctre/package-tree.html b/docs/swervelib/simulation/ctre/package-tree.html
index 2dc0dbd..b334aa6 100644
--- a/docs/swervelib/simulation/ctre/package-tree.html
+++ b/docs/swervelib/simulation/ctre/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.simulation.ctre Class Hierarchy
diff --git a/docs/swervelib/simulation/package-summary.html b/docs/swervelib/simulation/package-summary.html
index 0b68a7f..b2a4862 100644
--- a/docs/swervelib/simulation/package-summary.html
+++ b/docs/swervelib/simulation/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.simulation
diff --git a/docs/swervelib/simulation/package-tree.html b/docs/swervelib/simulation/package-tree.html
index 77bad7d..c7420d5 100644
--- a/docs/swervelib/simulation/package-tree.html
+++ b/docs/swervelib/simulation/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.simulation Class Hierarchy
diff --git a/docs/swervelib/telemetry/SwerveDriveTelemetry.TelemetryVerbosity.html b/docs/swervelib/telemetry/SwerveDriveTelemetry.TelemetryVerbosity.html
index 2ae32d7..d3ef467 100644
--- a/docs/swervelib/telemetry/SwerveDriveTelemetry.TelemetryVerbosity.html
+++ b/docs/swervelib/telemetry/SwerveDriveTelemetry.TelemetryVerbosity.html
@@ -1,7 +1,7 @@
-
+
SwerveDriveTelemetry.TelemetryVerbosity
diff --git a/docs/swervelib/telemetry/SwerveDriveTelemetry.html b/docs/swervelib/telemetry/SwerveDriveTelemetry.html
index 2d3579e..6f2aa52 100644
--- a/docs/swervelib/telemetry/SwerveDriveTelemetry.html
+++ b/docs/swervelib/telemetry/SwerveDriveTelemetry.html
@@ -1,7 +1,7 @@
-
+
SwerveDriveTelemetry
diff --git a/docs/swervelib/telemetry/package-summary.html b/docs/swervelib/telemetry/package-summary.html
index d7cfb6a..5401227 100644
--- a/docs/swervelib/telemetry/package-summary.html
+++ b/docs/swervelib/telemetry/package-summary.html
@@ -1,7 +1,7 @@
-
+
swervelib.telemetry
diff --git a/docs/swervelib/telemetry/package-tree.html b/docs/swervelib/telemetry/package-tree.html
index 52886c6..6d0bb36 100644
--- a/docs/swervelib/telemetry/package-tree.html
+++ b/docs/swervelib/telemetry/package-tree.html
@@ -1,7 +1,7 @@
-
+
swervelib.telemetry Class Hierarchy
diff --git a/swervelib/SwerveDrive.java b/swervelib/SwerveDrive.java
index f6fe1e1..6e5b00e 100644
--- a/swervelib/SwerveDrive.java
+++ b/swervelib/SwerveDrive.java
@@ -69,27 +69,27 @@ public class SwerveDrive
* Trustworthiness of the vision system Measured in expected standard deviation (meters of position and degrees of
* rotation)
*/
- public Matrix visionMeasurementStdDevs = VecBuilder.fill(0.9, 0.9, 0.9);
+ public Matrix visionMeasurementStdDevs = VecBuilder.fill(0.9, 0.9, 0.9);
/**
* Invert odometry readings of drive motor positions, used as a patch for debugging currently.
*/
- public boolean invertOdometry = false;
+ public boolean invertOdometry = false;
/**
* Swerve IMU device for sensing the heading of the robot.
*/
- private SwerveIMU imu;
+ private SwerveIMU imu;
/**
* Simulation of the swerve drive.
*/
- private SwerveIMUSimulation simIMU;
+ private SwerveIMUSimulation simIMU;
/**
* Counter to synchronize the modules relative encoder with absolute encoder when not moving.
*/
- private int moduleSynchronizationCounter = 0;
+ private int moduleSynchronizationCounter = 0;
/**
* The last heading set in radians.
*/
- private double lastHeadingRadians = 0;
+ private double lastHeadingRadians = 0;
/**
* Creates a new swerve drivebase subsystem. Robot is controlled via the {@link SwerveDrive#drive} method, or via the
diff --git a/swervelib/imu/ADIS16448Swerve.java b/swervelib/imu/ADIS16448Swerve.java
index 1aa483d..afb7a78 100644
--- a/swervelib/imu/ADIS16448Swerve.java
+++ b/swervelib/imu/ADIS16448Swerve.java
@@ -34,7 +34,7 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void factoryDefault()
{
- yawOffset = Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = (imu.getAngle() % 360);
}
/**
@@ -54,7 +54,7 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
- yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = (yaw % 360) + (imu.getAngle() % 360);
}
/**
@@ -65,9 +65,9 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
- yprArray[0] = Math.IEEEremainder(imu.getAngle(), 360) - yawOffset;
- yprArray[1] = Math.IEEEremainder(imu.getXComplementaryAngle(), 360);
- yprArray[2] = Math.IEEEremainder(imu.getYComplementaryAngle(), 360);
+ yprArray[0] = (imu.getAngle() % 360) - yawOffset;
+ yprArray[1] = imu.getXComplementaryAngle() % 360;
+ yprArray[2] = imu.getYComplementaryAngle() % 360;
}
/**
diff --git a/swervelib/imu/ADIS16470Swerve.java b/swervelib/imu/ADIS16470Swerve.java
index d0f01bb..34e8aef 100644
--- a/swervelib/imu/ADIS16470Swerve.java
+++ b/swervelib/imu/ADIS16470Swerve.java
@@ -34,7 +34,7 @@ public class ADIS16470Swerve extends SwerveIMU
@Override
public void factoryDefault()
{
- yawOffset = Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = imu.getAngle() % 360;
}
/**
@@ -54,7 +54,7 @@ public class ADIS16470Swerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
- yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = (yaw % 360) + (imu.getAngle() % 360);
}
/**
@@ -65,9 +65,9 @@ public class ADIS16470Swerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
- yprArray[0] = Math.IEEEremainder(imu.getAngle(), 360) - yawOffset;
- yprArray[1] = Math.IEEEremainder(imu.getXComplementaryAngle(), 360);
- yprArray[2] = Math.IEEEremainder(imu.getYComplementaryAngle(), 360);
+ yprArray[0] = (imu.getAngle() % 360) - yawOffset;
+ yprArray[1] = imu.getXComplementaryAngle() % 360;
+ yprArray[2] = imu.getYComplementaryAngle() % 360;
}
/**
diff --git a/swervelib/imu/ADXRS450Swerve.java b/swervelib/imu/ADXRS450Swerve.java
index 6a9d97f..9ce3cb9 100644
--- a/swervelib/imu/ADXRS450Swerve.java
+++ b/swervelib/imu/ADXRS450Swerve.java
@@ -34,7 +34,7 @@ public class ADXRS450Swerve extends SwerveIMU
@Override
public void factoryDefault()
{
- yawOffset = Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = imu.getAngle() % 360;
}
/**
@@ -54,7 +54,7 @@ public class ADXRS450Swerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
- yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(imu.getAngle(), 360);
+ yawOffset = (yaw % 360) + (imu.getAngle() % 360);
}
/**
@@ -65,7 +65,7 @@ public class ADXRS450Swerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
- yprArray[0] = Math.IEEEremainder(imu.getAngle(), 360) - yawOffset;
+ yprArray[0] = (imu.getAngle() % 360) - yawOffset;
yprArray[1] = 0;
yprArray[2] = 0;
}
diff --git a/swervelib/imu/AnalogGyroSwerve.java b/swervelib/imu/AnalogGyroSwerve.java
index 1cd60cd..15a63d4 100644
--- a/swervelib/imu/AnalogGyroSwerve.java
+++ b/swervelib/imu/AnalogGyroSwerve.java
@@ -41,7 +41,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void factoryDefault()
{
- yawOffset = Math.IEEEremainder(gyro.getAngle(), 360);
+ yawOffset = gyro.getAngle() % 360;
}
/**
@@ -61,7 +61,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
- yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(gyro.getAngle(), 360);
+ yawOffset = (yaw % 360) + (gyro.getAngle() % 360);
}
/**
@@ -72,7 +72,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
- yprArray[0] = Math.IEEEremainder(gyro.getAngle(), 360) - yawOffset;
+ yprArray[0] = (gyro.getAngle() % 360) - yawOffset;
yprArray[1] = 0;
yprArray[2] = 0;
}
diff --git a/swervelib/imu/NavXSwerve.java b/swervelib/imu/NavXSwerve.java
index 46aa41c..9c0cbb4 100644
--- a/swervelib/imu/NavXSwerve.java
+++ b/swervelib/imu/NavXSwerve.java
@@ -47,7 +47,7 @@ public class NavXSwerve extends SwerveIMU
public void factoryDefault()
{
// gyro.reset(); // Reported to be slow
- yawOffset = Math.IEEEremainder(gyro.getYaw(), 360);
+ yawOffset = gyro.getYaw() % 360;
}
/**
@@ -67,7 +67,7 @@ public class NavXSwerve extends SwerveIMU
public void setYaw(double yaw)
{
// gyro.reset(); // Reported to be slow using the offset.
- yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(gyro.getYaw(), 360);
+ yawOffset = (yaw % 360) + (gyro.getYaw() % 360);
}
/**
@@ -79,9 +79,9 @@ public class NavXSwerve extends SwerveIMU
public void getYawPitchRoll(double[] yprArray)
{
- yprArray[0] = (Math.IEEEremainder(gyro.getYaw(), 360)) - yawOffset;
- yprArray[1] = Math.IEEEremainder(gyro.getPitch(), 360);
- yprArray[2] = Math.IEEEremainder(gyro.getRoll(), 360);
+ yprArray[0] = (gyro.getYaw() % 360) - yawOffset;
+ yprArray[1] = (gyro.getPitch() % 360);
+ yprArray[2] = (gyro.getRoll() % 360);
}
/**
diff --git a/swervelib/motors/TalonFXSwerve.java b/swervelib/motors/TalonFXSwerve.java
index 967fdfa..756af0a 100644
--- a/swervelib/motors/TalonFXSwerve.java
+++ b/swervelib/motors/TalonFXSwerve.java
@@ -280,7 +280,7 @@ public class TalonFXSwerve extends SwerveMotor
{
double lowerBound;
double upperBound;
- double lowerOffset = Math.IEEEremainder(scopeReference, 360);
+ double lowerOffset = (scopeReference % 360);
// Create the interval from the reference angle.
if (lowerOffset >= 0)
diff --git a/swervelib/motors/TalonSRXSwerve.java b/swervelib/motors/TalonSRXSwerve.java
index 47dad38..bf88b37 100644
--- a/swervelib/motors/TalonSRXSwerve.java
+++ b/swervelib/motors/TalonSRXSwerve.java
@@ -270,7 +270,7 @@ public class TalonSRXSwerve extends SwerveMotor
{
double lowerBound;
double upperBound;
- double lowerOffset = Math.IEEEremainder(scopeReference, 360);
+ double lowerOffset = (scopeReference % 360);
// Create the interval from the reference angle.
if (lowerOffset >= 0)
diff --git a/swervelib/simulation/ctre/PhysicsSim.java b/swervelib/simulation/ctre/PhysicsSim.java
index 189e49c..1254e99 100644
--- a/swervelib/simulation/ctre/PhysicsSim.java
+++ b/swervelib/simulation/ctre/PhysicsSim.java
@@ -31,7 +31,7 @@ public class PhysicsSim
/* scales a random domain of [0, 2pi] to [min, max] while prioritizing the peaks */
static double random(double min, double max)
{
- return (max - min) / 2 * Math.sin(Math.IEEEremainder(Math.random(), 2 * 3.14159))
+ return (max - min) / 2 * Math.sin((Math.random() % 2 * Math.PI))
+ (max + min) / 2;
}