Team_2648/2025_Robot_Code
5
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

auto sucky

Browse Source
This commit is contained in:
Team 2648 2025-04-03 19:59:58 -04:00
parent a391cc7910
commit 3dcbac25cc
7 changed files with 34 additions and 34 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/main/deploy/pathplanner/paths/30 Right to HP.path
View File

@ -16,12 +16,12 @@
},
{
"anchor": {
"x": 1.1987704918032787,
"y": 7.189754098360656
"x": 1.0549180327868852,
"y": 7.285655737704918
},
"prevControl": {
"x": 2.055234532899169,
"y": 6.243135947675724
"x": 1.9113820738827756,
"y": 6.339037587019986
},
"nextControl": null,
"isLocked": false,

20
src/main/deploy/pathplanner/paths/HP to 330 Right.path
View File

@ -3,25 +3,25 @@
"waypoints": [
{
"anchor": {
"x": 1.1987704918032787,
"y": 7.189754098360656
"x": 1.0549180327868852,
"y": 7.285655737704918
},
"prevControl": null,
"nextControl": {
"x": 2.490979395912868,
"y": 6.964368824388053
"x": 2.3471269368964744,
"y": 7.060270463732315
},
"isLocked": false,
"linkedName": "HP Left Position"
},
{
"anchor": {
"x": 3.6202868852459016,
"y": 5.031967213114754
"x": 3.65625,
"y": 5.05594262295082
},
"prevControl": {
"x": 3.304747501684258,
"y": 5.557866185717494
"x": 3.3407106164383564,
"y": 5.581841595553559
},
"nextControl": null,
"isLocked": false,
@ -46,7 +46,7 @@
],
"globalConstraints": {
"maxVelocity": 3.5,
"maxAcceleration": 1.75,
"maxAcceleration": 1.25,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 400.0,
"nominalVoltage": 12.0,
@ -62,5 +62,5 @@
"velocity": 0,
"rotation": -53.97262661489646
},
"useDefaultConstraints": true
"useDefaultConstraints": false
}

8
src/main/deploy/pathplanner/paths/HP to K.path
View File

@ -3,13 +3,13 @@
"waypoints": [
{
"anchor": {
"x": 1.1987704918032787,
"y": 7.189754098360656
"x": 1.0549180327868852,
"y": 7.285655737704918
},
"prevControl": null,
"nextControl": {
"x": 1.7142418032786886,
"y": 6.638319672131147
"x": 1.5703893442622952,
"y": 6.734221311475409
},
"isLocked": false,
"linkedName": "HP Left Position"

16
src/main/deploy/pathplanner/paths/L Backup.path
View File

@ -3,25 +3,25 @@
"waypoints": [
{
"anchor": {
"x": 3.6202868852459016,
"y": 5.031967213114754
"x": 3.65625,
"y": 5.05594262295082
},
"prevControl": null,
"nextControl": {
"x": 3.4877871502451065,
"y": 5.243966789116026
"x": 3.523750264999205,
"y": 5.267942198952092
},
"isLocked": false,
"linkedName": "L"
},
{
"anchor": {
"x": 1.1987704918032787,
"y": 7.189754098360656
"x": 1.0549180327868852,
"y": 7.285655737704918
},
"prevControl": {
"x": 1.4025614754098363,
"y": 6.914036885245903
"x": 1.258709016393443,
"y": 7.009938524590164
},
"nextControl": null,
"isLocked": false,

4
src/main/deploy/pathplanner/paths/Start to 30 Right.path
View File

@ -46,7 +46,7 @@
],
"globalConstraints": {
"maxVelocity": 3.5,
"maxAcceleration": 1.75,
"maxAcceleration": 1.5,
"maxAngularVelocity": 540.0,
"maxAngularAcceleration": 400.0,
"nominalVoltage": 12.0,
@ -62,5 +62,5 @@
"velocity": 0,
"rotation": -90.0
},
"useDefaultConstraints": true
"useDefaultConstraints": false
}

8
src/main/java/frc/robot/subsystems/Drivetrain.java
View File

@ -112,7 +112,7 @@ public class Drivetrain extends SubsystemBase {
},
new Pose2d(),
VecBuilder.fill(0.1, 0.1, Units.degreesToRadians(5)),
VecBuilder.fill(1, 1, Units.degreesToRadians(360))
VecBuilder.fill(0.2, 0.2, Units.degreesToRadians(360))
);
pidHeading = new ProfiledPIDController(AutoConstants.kAlignPThetaController, 0, 0, AutoConstants.kAlignThetaControllerConstraints);
@ -177,11 +177,11 @@ public class Drivetrain extends SubsystemBase {
gyroBuffer.addSample(Timer.getFPGATimestamp(), m_estimator.getEstimatedPosition().getRotation().getDegrees());
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.3, 0.3, Units.degreesToRadians(360)));
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.10, 0.10, Units.degreesToRadians(360)));
if(vision.getOrangeTagDetected() && vision.getOrangeTagDetected()){
if(vision.getOrangeDist() < 60){
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.1, 0.1, Units.degreesToRadians(360)));
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.025, 0.025, Units.degreesToRadians(360)));
}
// if the detected tags match your alliances reef tags use their pose estimates
@ -199,7 +199,7 @@ public class Drivetrain extends SubsystemBase {
if(vision.getBlackTagDetected() && vision.getBlackTagDetected()){
if(vision.getBlackDist() < 60){
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.1, 0.1, Units.degreesToRadians(360)));
m_estimator.setVisionMeasurementStdDevs(VecBuilder.fill(0.025, 0.025, Units.degreesToRadians(360)));
}
if(vision.getBlackClosestTag() >= 6 && vision.getBlackClosestTag() <= 11 && DriverStation.getAlliance().get().equals(Alliance.Red) && vision.getBlackTagDetected()){

4
src/main/java/frc/robot/subsystems/Manipulator.java
View File

@ -84,8 +84,8 @@ public class Manipulator extends SubsystemBase {
*/
public Command runUntilCollected(DoubleSupplier speed) {
return run(() -> {
manipulatorMotor.set(
speed.getAsDouble()
manipulatorMotor.setVoltage(
speed.getAsDouble()*12
);
indexerMotor.set(1);