CODE CHANGES:
Test EVERYTHING [FINISHED]
SUBSYSTEMS AND UTILITY TESTING:
Fully Test Controllers [FINISHED] Fully Test Angles [FINISHED] Fully Test Point [FINISHED] Fully Test Vector [FINISHED] Fully Test RobotPose [FINISHED] Fully Test MotionProfile [FINISHED] Fully Test PointMotionProfile [FINISHED] Fully Test SimpleFeedbackController [FINISHED] Fully Test FeedbackController [FINISHED] Fully Test ParabolicPathPlanning [FINISHED] Fully Test LerpPathPlanning [FINISHED] Fully Test Hand [FINISHED] Fully Test Lights [FINISHED] Fully Test AprilTagVision [FINISHED] Fully Test TensorFlowVision [FINISHED] Fully Test Arm [FINISHED] Fully Test Drivetrain [FINISHED]
CONSTANTS TUNING:
ArmConstants - tune PlaneLauncher range [FINISHED] ArmConstants - tune shoulder max power [FINISHED] ArmConstants - tune shoulder p [FINISHED] ArmConstants - tune shoulder vertical p [FINISHED] ArmConstants - tune arm vertical position [FINISHED] ArmConstants - tune wrist max power [FINISHED] ArmConstants - tune wrist p [FINISHED] ArmConstants - tune wrist fourbar positions [FINISHED] ArmConstants - tune fourbar switching angle [FINISHED] ArmConstants - tune all arm set positions [FINISHED] ArmConstants - tune auto arm offset [FINISHED] ArmConstants - tune auto wrist offset [FINISHED]
ControllerConstants - tune deadband [FINISHED] ControllerConstants - tune wait time [FINISHED]
DrivetrainConstants - Tune Profile Speeds [FINISHED] DrivetrainConstants - Tune Turning Max [FINISHED] DrivetrainConstants - Tune virtual gears [FINISHED] DrivetrainConstants - Tune auto align p [FINISHED] DrivetrainConstants - Tune auto align error [FINISHED] DrivetrainConstants - tune Drive Motor FF [FINISHED] DrivetrainConstants - Tune odometry corrections [FINISHED]
HandConstants - tune all Grabber ranges [FINISHED]
SplineConstants - Tune Spline P [FINISHED] SplineConstants - Tune Spline error [FINISHED]
VisionConstants - tune camera offsets [FINISHED] VisionConstants - tune both thresholds [FINISHED]