-
Notifications
You must be signed in to change notification settings - Fork 10
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Merge pull request #13 from RoboLancers/dev-drivetrain
Dev drivetrain
- Loading branch information
Showing
21 changed files
with
1,620 additions
and
193 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,12 @@ | ||
| { | ||
| "robotWidth": 0.9, | ||
| "robotLength": 0.9, | ||
| "holonomicMode": true, | ||
| "pathFolders": [], | ||
| "autoFolders": [], | ||
| "defaultMaxVel": 3.0, | ||
| "defaultMaxAccel": 3.0, | ||
| "defaultMaxAngVel": 540.0, | ||
| "defaultMaxAngAccel": 720.0, | ||
| "maxModuleSpeed": 4.5 | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,25 @@ | ||
| { | ||
| "version": 1.0, | ||
| "startingPose": { | ||
| "position": { | ||
| "x": 2, | ||
| "y": 7.0 | ||
| }, | ||
| "rotation": 0 | ||
| }, | ||
| "command": { | ||
| "type": "sequential", | ||
| "data": { | ||
| "commands": [ | ||
| { | ||
| "type": "path", | ||
| "data": { | ||
| "pathName": "Example Path" | ||
| } | ||
| } | ||
| ] | ||
| } | ||
| }, | ||
| "folder": null, | ||
| "choreoAuto": false | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1 @@ | ||
| {"field_size":{"x":16.54,"y":8.21},"nodeSizeMeters":0.3,"grid":[[true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true],[true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true],[true,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true],[true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,true,true],[true,true,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,true,true,true],[true,true,true,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,true,true,true,true],[true,true,true,true,false,false,false,false,false,false,true,true,true,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,true,true,true,false,false,false,false,false,false,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true],[true,true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true,true],[true,true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true,true],[true,true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true,true],[true,true,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,true,true],[true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true],[true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true],[true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true,true]]} |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,49 @@ | ||
| { | ||
| "version": 1.0, | ||
| "waypoints": [ | ||
| { | ||
| "anchor": { | ||
| "x": 2.0, | ||
| "y": 7.0 | ||
| }, | ||
| "prevControl": null, | ||
| "nextControl": { | ||
| "x": 2.5, | ||
| "y": 7.0 | ||
| }, | ||
| "isLocked": false, | ||
| "linkedName": null | ||
| }, | ||
| { | ||
| "anchor": { | ||
| "x": 4.0, | ||
| "y": 7.0 | ||
| }, | ||
| "prevControl": { | ||
| "x": 3.5, | ||
| "y": 7.0 | ||
| }, | ||
| "nextControl": null, | ||
| "isLocked": false, | ||
| "linkedName": null | ||
| } | ||
| ], | ||
| "rotationTargets": [], | ||
| "constraintZones": [], | ||
| "eventMarkers": [], | ||
| "globalConstraints": { | ||
| "maxVelocity": 3.0, | ||
| "maxAcceleration": 3.0, | ||
| "maxAngularVelocity": 540.0, | ||
| "maxAngularAcceleration": 720.0 | ||
| }, | ||
| "goalEndState": { | ||
| "velocity": 0, | ||
| "rotation": 180.0, | ||
| "rotateFast": false | ||
| }, | ||
| "reversed": false, | ||
| "folder": null, | ||
| "previewStartingState": null, | ||
| "useDefaultConstraints": false | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -1,29 +1,82 @@ | ||
| /* (C) Robolancers 2024 */ | ||
| package org.robolancers321; | ||
|
|
||
| import com.pathplanner.lib.auto.AutoBuilder; | ||
| import edu.wpi.first.wpilibj.XboxController; | ||
| import edu.wpi.first.wpilibj.smartdashboard.SendableChooser; | ||
| import edu.wpi.first.wpilibj2.command.Command; | ||
| import edu.wpi.first.wpilibj2.command.Commands; | ||
| import edu.wpi.first.wpilibj2.command.InstantCommand; | ||
| import edu.wpi.first.wpilibj2.command.button.Trigger; | ||
| import org.robolancers321.subsystems.drivetrain.Drivetrain; | ||
| import org.robolancers321.subsystems.intake.Intake; | ||
| import org.robolancers321.subsystems.launcher.Launcher; | ||
|
|
||
| public class RobotContainer { | ||
| Drivetrain drivetrain; | ||
| Intake intake; | ||
| Launcher launcher; | ||
|
|
||
| XboxController driverController; | ||
| XboxController manipulatorController; | ||
|
|
||
| SendableChooser<Command> autoChooser; | ||
|
|
||
| public RobotContainer() { | ||
| this.drivetrain = Drivetrain.getInstance(); | ||
| this.intake = Intake.getInstance(); | ||
| this.launcher = Launcher.getInstance(); | ||
|
|
||
| this.intake.retractor.setDefaultCommand(this.intake.retractor.tuneControllers()); | ||
| this.launcher.pivot.setDefaultCommand(this.launcher.pivot.tuneControllers()); | ||
| this.launcher.flywheel.setDefaultCommand(this.launcher.flywheel.tuneController()); | ||
|
|
||
| configureBindings(); | ||
| this.driverController = new XboxController(0); | ||
| this.manipulatorController = new XboxController(1); | ||
|
|
||
| this.autoChooser = AutoBuilder.buildAutoChooser(); | ||
|
|
||
| this.configureBindings(); | ||
| this.configureAutoChooser(); | ||
| } | ||
|
|
||
| private void configureBindings() { | ||
| this.drivetrain.setDefaultCommand(this.drivetrain.teleopDrive(driverController, true)); | ||
|
|
||
| new Trigger(this.driverController::getAButton).onTrue(this.drivetrain.zeroYaw()); | ||
|
|
||
| new Trigger(() -> this.driverController.getRightTriggerAxis() > 0.8) | ||
| .onTrue(this.intake.retractor.moveToIntake()); | ||
|
|
||
| new Trigger(() -> this.driverController.getRightTriggerAxis() > 0.8) | ||
| .onFalse(this.intake.retractor.moveToRetracted()); | ||
|
|
||
| new Trigger(() -> this.manipulatorController.getRightTriggerAxis() > 0.8) | ||
| .onTrue(this.launcher.pivot.aimAtAmp()); | ||
|
|
||
| new Trigger(() -> this.manipulatorController.getRightTriggerAxis() > 0.8) | ||
| .onFalse(this.launcher.pivot.moveToRetracted()); | ||
| } | ||
|
|
||
| private void configureBindings() {} | ||
| private void configureAutoChooser() { | ||
| // NamedCommands.registerCommand("Say Hello", new PrintCommand("Hello")); | ||
|
|
||
| // this.autoChooser.addOption("Do Nothing", new InstantCommand()); | ||
| } | ||
|
|
||
| public Command getAutonomousCommand() { | ||
| return Commands.print("No autonomous command configured"); | ||
| return new InstantCommand(); | ||
|
|
||
| // return new PathPlannerAuto("tuning"); | ||
|
|
||
| // var curr = drivetrain.getPose(); | ||
|
|
||
| // var path = | ||
| // new PathPlannerPath( | ||
| // PathPlannerPath.bezierFromPoses( | ||
| // curr, | ||
| // new Pose2d(1.2, 5.3, Rotation2d.fromDegrees(0)), | ||
| // new Pose2d(1, 5.3, Rotation2d.fromDegrees(0))), | ||
| // Drivetrain.kAutoConstraints, | ||
| // new GoalEndState(0, Rotation2d.fromDegrees(0))); | ||
|
|
||
| // path.preventFlipping = true; | ||
|
|
||
| // return AutoBuilder.followPath(path); | ||
| } | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Oops, something went wrong.