all 3 auto spikes work

This commit is contained in:
sihan 2023-11-08 11:31:33 -06:00
parent 54b6548d36
commit e84fe97cb4
17 changed files with 33 additions and 2 deletions

View File

@ -10,6 +10,7 @@ import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.util.NanoClock; import com.acmerobotics.roadrunner.util.NanoClock;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.util.RobotLog; import com.qualcomm.robotcore.util.RobotLog;
@ -33,6 +34,7 @@ import java.util.List;
* regression. * regression.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class AutomaticFeedforwardTuner extends LinearOpMode { public class AutomaticFeedforwardTuner extends LinearOpMode {
public static double MAX_POWER = 0.7; public static double MAX_POWER = 0.7;

View File

@ -4,6 +4,7 @@ import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.trajectory.Trajectory; import com.acmerobotics.roadrunner.trajectory.Trajectory;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive; import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
@ -25,6 +26,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* is recommended that you use the FollowerPIDTuner opmode for further fine tuning. * is recommended that you use the FollowerPIDTuner opmode for further fine tuning.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class BackAndForth extends LinearOpMode { public class BackAndForth extends LinearOpMode {

View File

@ -15,6 +15,7 @@ import com.acmerobotics.roadrunner.profile.MotionProfileGenerator;
import com.acmerobotics.roadrunner.profile.MotionState; import com.acmerobotics.roadrunner.profile.MotionState;
import com.acmerobotics.roadrunner.util.NanoClock; import com.acmerobotics.roadrunner.util.NanoClock;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor; import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.util.RobotLog; import com.qualcomm.robotcore.util.RobotLog;
@ -49,6 +50,7 @@ import java.util.List;
* Pressing B/O (Xbox/PS4) will cede control back to the tuning process. * Pressing B/O (Xbox/PS4) will cede control back to the tuning process.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class DriveVelocityPIDTuner extends LinearOpMode { public class DriveVelocityPIDTuner extends LinearOpMode {
public static double DISTANCE = 72; // in public static double DISTANCE = 72; // in

View File

@ -3,6 +3,7 @@ package org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.opmode;
import com.acmerobotics.dashboard.config.Config; import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive; import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
@ -23,6 +24,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.trajectorysequence.Tra
* These coefficients can be tuned live in dashboard. * These coefficients can be tuned live in dashboard.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class FollowerPIDTuner extends LinearOpMode { public class FollowerPIDTuner extends LinearOpMode {
public static double DISTANCE = 48; // in public static double DISTANCE = 48; // in

View File

@ -1,6 +1,7 @@
package org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.opmode; package org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.opmode;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp; import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
import com.qualcomm.robotcore.hardware.DcMotor; import com.qualcomm.robotcore.hardware.DcMotor;
@ -14,6 +15,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* exercise is to ascertain whether the localizer has been configured properly (note: the pure * exercise is to ascertain whether the localizer has been configured properly (note: the pure
* encoder localizer heading may be significantly off if the track width has not been tuned). * encoder localizer heading may be significantly off if the track width has not been tuned).
*/ */
@Disabled
@TeleOp(group = "drive") @TeleOp(group = "drive")
public class LocalizationTest extends LinearOpMode { public class LocalizationTest extends LinearOpMode {
@Override @Override

View File

@ -17,6 +17,7 @@ import com.acmerobotics.roadrunner.profile.MotionProfileGenerator;
import com.acmerobotics.roadrunner.profile.MotionState; import com.acmerobotics.roadrunner.profile.MotionState;
import com.acmerobotics.roadrunner.util.NanoClock; import com.acmerobotics.roadrunner.util.NanoClock;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.VoltageSensor; import com.qualcomm.robotcore.hardware.VoltageSensor;
import com.qualcomm.robotcore.util.RobotLog; import com.qualcomm.robotcore.util.RobotLog;
@ -42,6 +43,7 @@ import java.util.Objects;
* Pressing B/O (Xbox/PS4) will cede control back to the tuning process. * Pressing B/O (Xbox/PS4) will cede control back to the tuning process.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class ManualFeedforwardTuner extends LinearOpMode { public class ManualFeedforwardTuner extends LinearOpMode {
public static double DISTANCE = 72; // in public static double DISTANCE = 72; // in

View File

@ -5,6 +5,7 @@ import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.dashboard.telemetry.MultipleTelemetry; import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor; import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.util.ElapsedTime; import com.qualcomm.robotcore.util.ElapsedTime;
@ -23,6 +24,7 @@ import java.util.Objects;
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class MaxAngularVeloTuner extends LinearOpMode { public class MaxAngularVeloTuner extends LinearOpMode {
public static double RUNTIME = 4.0; public static double RUNTIME = 4.0;

View File

@ -5,6 +5,7 @@ import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.dashboard.telemetry.MultipleTelemetry; import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor; import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.hardware.VoltageSensor; import com.qualcomm.robotcore.hardware.VoltageSensor;
@ -25,6 +26,7 @@ import java.util.Objects;
* Further fine tuning of kF may be desired. * Further fine tuning of kF may be desired.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class MaxVelocityTuner extends LinearOpMode { public class MaxVelocityTuner extends LinearOpMode {
public static double RUNTIME = 2.0; public static double RUNTIME = 2.0;

View File

@ -38,6 +38,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* *
* Uncomment the @Disabled tag below to use this opmode. * Uncomment the @Disabled tag below to use this opmode.
*/ */
@Disabled @Disabled
@Config @Config
@TeleOp(group = "drive") @TeleOp(group = "drive")

View File

@ -4,6 +4,7 @@ import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.geometry.Vector2d; import com.acmerobotics.roadrunner.geometry.Vector2d;
import com.acmerobotics.roadrunner.trajectory.Trajectory; import com.acmerobotics.roadrunner.trajectory.Trajectory;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive; import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
@ -11,6 +12,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
/* /*
* This is an example of a more complex path to really test the tuning. * This is an example of a more complex path to really test the tuning.
*/ */
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class SplineTest extends LinearOpMode { public class SplineTest extends LinearOpMode {
@Override @Override

View File

@ -6,6 +6,7 @@ import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.trajectory.Trajectory; import com.acmerobotics.roadrunner.trajectory.Trajectory;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.robotcore.external.Telemetry; import org.firstinspires.ftc.robotcore.external.Telemetry;
@ -15,6 +16,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* This is a simple routine to test translational drive capabilities. * This is a simple routine to test translational drive capabilities.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class StrafeTest extends LinearOpMode { public class StrafeTest extends LinearOpMode {
public static double DISTANCE = 60; // in public static double DISTANCE = 60; // in

View File

@ -6,6 +6,7 @@ import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.trajectory.Trajectory; import com.acmerobotics.roadrunner.trajectory.Trajectory;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.robotcore.external.Telemetry; import org.firstinspires.ftc.robotcore.external.Telemetry;
@ -15,6 +16,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* This is a simple routine to test translational drive capabilities. * This is a simple routine to test translational drive capabilities.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class StraightTest extends LinearOpMode { public class StraightTest extends LinearOpMode {
public static double DISTANCE = 60; // in public static double DISTANCE = 60; // in

View File

@ -6,6 +6,7 @@ import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.util.Angle; import com.acmerobotics.roadrunner.util.Angle;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.util.MovingStatistics; import com.qualcomm.robotcore.util.MovingStatistics;
@ -24,6 +25,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* accurate track width estimate is important or else the angular constraints will be thrown off. * accurate track width estimate is important or else the angular constraints will be thrown off.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class TrackWidthTuner extends LinearOpMode { public class TrackWidthTuner extends LinearOpMode {
public static double ANGLE = 180; // deg public static double ANGLE = 180; // deg

View File

@ -6,6 +6,7 @@ import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.util.Angle; import com.acmerobotics.roadrunner.util.Angle;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.util.MovingStatistics; import com.qualcomm.robotcore.util.MovingStatistics;
import com.qualcomm.robotcore.util.RobotLog; import com.qualcomm.robotcore.util.RobotLog;
@ -35,6 +36,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.StandardTracking
* satisfactory result is produced. * satisfactory result is produced.
*/ */
@Config @Config
@Disabled
@Autonomous(group="drive") @Autonomous(group="drive")
public class TrackingWheelForwardOffsetTuner extends LinearOpMode { public class TrackingWheelForwardOffsetTuner extends LinearOpMode {
public static double ANGLE = 180; // deg public static double ANGLE = 180; // deg

View File

@ -3,6 +3,7 @@ package org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.opmode;
import com.acmerobotics.dashboard.config.Config; import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.roadrunner.geometry.Pose2d; import com.acmerobotics.roadrunner.geometry.Pose2d;
import com.acmerobotics.roadrunner.util.Angle; import com.acmerobotics.roadrunner.util.Angle;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp; import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
import com.qualcomm.robotcore.util.RobotLog; import com.qualcomm.robotcore.util.RobotLog;
@ -62,6 +63,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.StandardTracking
* precision. The heading should still line up. * precision. The heading should still line up.
*/ */
@Config @Config
@Disabled
@TeleOp(group = "drive") @TeleOp(group = "drive")
public class TrackingWheelLateralDistanceTuner extends LinearOpMode { public class TrackingWheelLateralDistanceTuner extends LinearOpMode {
public static int NUM_TURNS = 10; public static int NUM_TURNS = 10;

View File

@ -2,6 +2,7 @@ package org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.opmode;
import com.acmerobotics.dashboard.config.Config; import com.acmerobotics.dashboard.config.Config;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous; import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive; import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
@ -10,6 +11,7 @@ import org.firstinspires.ftc.teamcode.hardware.roadrunner.drive.MecanumDrive;
* This is a simple routine to test turning capabilities. * This is a simple routine to test turning capabilities.
*/ */
@Config @Config
@Disabled
@Autonomous(group = "drive") @Autonomous(group = "drive")
public class TurnTest extends LinearOpMode { public class TurnTest extends LinearOpMode {
public static double ANGLE = 90; // deg public static double ANGLE = 90; // deg

View File

@ -42,12 +42,12 @@ public class Auto extends LinearOpMode {
//Preload Two //Preload Two
this.preloadTwo = this.robot.getDrive().trajectoryBuilder(initialPosition) this.preloadTwo = this.robot.getDrive().trajectoryBuilder(initialPosition)
.lineToLinearHeading(new Pose2d(40,-25, Math.toRadians(270))) .lineToLinearHeading(new Pose2d(35,-27, Math.toRadians(270)))
.build(); .build();
//Preload Three //Preload Three
this.preloadThree = this.robot.getDrive().trajectoryBuilder(initialPosition) this.preloadThree = this.robot.getDrive().trajectoryBuilder(initialPosition)
.lineToLinearHeading(new Pose2d(47.5,-37.5, Math.toRadians(270))) .lineToLinearHeading(new Pose2d(46,-35, Math.toRadians(270)))
.build(); .build();
// Do super fancy chinese shit // Do super fancy chinese shit