Skip to content

Commit

Permalink
add pathfinding
Browse files Browse the repository at this point in the history
  • Loading branch information
mpatankar6 committed Feb 17, 2024
1 parent 6bf525e commit 9374282
Show file tree
Hide file tree
Showing 9 changed files with 436 additions and 9 deletions.
353 changes: 353 additions & 0 deletions .AdvantageScope/AdvantageScope 2-16-2024.json
Original file line number Diff line number Diff line change
@@ -0,0 +1,353 @@
{
"version": "3.0.2",
"layout": [
{
"type": 9,
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/SwerveStates/Setpoints",
"sourceTypeIndex": 1,
"sourceType": "SwerveModuleState[]"
},
{
"key": "NT:/AdvantageKit/RealOutputs/SwerveStates/Measured",
"sourceTypeIndex": 1,
"sourceType": "SwerveModuleState[]"
},
{
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/Estimated Pose/rotation",
"sourceTypeIndex": 1,
"sourceType": "Rotation2d"
}
],
"listFields": [],
"options": {
"maxSpeed": 4.5,
"rotationUnits": "radians",
"arrangement": "0,1,2,3",
"sizeLeftRight": 0.65,
"sizeFrontBack": 0.65,
"forwardDirection": "up"
},
"configHidden": false,
"title": "Swerve"
},
{
"type": 5,
"fields": [],
"listFields": [
[
{
"type": "Robot",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/Estimated Pose",
"sourceTypeIndex": 1,
"sourceType": "Pose2d"
},
{
"type": "Trajectory",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/Trajectory",
"sourceTypeIndex": 2,
"sourceType": "Pose2d[]"
},
{
"type": "Ghost",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/TrajectorySetpoint",
"sourceTypeIndex": 1,
"sourceType": "Pose2d"
},
{
"type": "Vision Target",
"key": "NT:/AdvantageKit/RealOutputs/Vision/TagPoses2D",
"sourceTypeIndex": 2,
"sourceType": "Pose2d[]"
}
]
],
"options": {
"game": "2024 Field",
"unitDistance": "meters",
"unitRotation": "radians",
"origin": "right",
"size": 0.75,
"allianceBumpers": "auto",
"allianceOrigin": "blue",
"orientation": "blue left, red right"
},
"configHidden": false,
"title": "Odometry"
},
{
"type": 6,
"fields": [],
"listFields": [
[
{
"type": "Vision Target",
"key": "NT:/AdvantageKit/RealOutputs/Vision/TagPoses",
"sourceTypeIndex": 2,
"sourceType": "Pose3d[]"
},
{
"type": "Component (Robot)",
"key": "NT:/AdvantageKit/RealOutputs/Mechanism3d/ArmMeasured",
"sourceTypeIndex": 2,
"sourceType": "Pose3d[]"
},
{
"type": "Component (Green Ghost)",
"key": "NT:/AdvantageKit/RealOutputs/Mechanism3d/ArmSetpoint",
"sourceTypeIndex": 2,
"sourceType": "Pose3d[]"
}
],
[
{
"type": "Robot",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/Estimated Pose",
"sourceTypeIndex": 1,
"sourceType": "Pose2d"
},
{
"type": "Trajectory",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/Trajectory",
"sourceTypeIndex": 2,
"sourceType": "Pose2d[]"
},
{
"type": "Yellow Ghost",
"key": "NT:/AdvantageKit/RealOutputs/Drivetrain/TrajectorySetpoint",
"sourceTypeIndex": 1,
"sourceType": "Pose2d"
},
{
"type": "Green Ghost",
"key": "NT:/AdvantageKit/RealOutputs/Vision/EstimatedPoses",
"sourceTypeIndex": 2,
"sourceType": "Pose2d[]"
}
]
],
"options": {
"field": "2024 Field",
"alliance": "blue",
"robot": "4909",
"unitDistance": "meters",
"unitRotation": "radians",
"cameraIndex": -1,
"fov": 50
},
"configHidden": false,
"title": "3D Field"
},
{
"type": 3,
"field": "NT:/AdvantageKit/RealOutputs/Console",
"title": "Console"
},
{
"type": 8,
"fields": [],
"listFields": [],
"options": {
"ids": [
0,
1,
2
],
"layouts": [
"Xbox Controller (White)",
"None",
"None"
]
},
"configHidden": false,
"title": "Joysticks"
},
{
"type": 1,
"legends": {
"left": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Elbow Feed Forward",
"color": "#2b66a2",
"show": true
},
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Wrist Feed Forward",
"color": "#e5b31b",
"show": true
}
]
},
"discrete": {
"fields": []
},
"right": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": []
}
},
"title": "Line Graph"
},
{
"type": 10,
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/Mechanism2d/ArmSetpoint",
"sourceTypeIndex": 0,
"sourceType": "Mechanism2d"
},
{
"key": "NT:/AdvantageKit/RealOutputs/Mechanism2d/ArmMeasured",
"sourceTypeIndex": 0,
"sourceType": "Mechanism2d"
},
null
],
"listFields": [],
"options": {},
"configHidden": false,
"title": "Mechanism"
},
{
"type": 1,
"legends": {
"left": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/LoggedRobot/FullCycleMS",
"color": "#2b66a2",
"show": true
}
]
},
"discrete": {
"fields": []
},
"right": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": []
}
},
"title": "Line Graph"
},
{
"type": 1,
"legends": {
"left": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Elbow Feed Forward",
"color": "#2b66a2",
"show": false
},
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Wrist Feed Forward",
"color": "#e5b31b",
"show": false
}
]
},
"discrete": {
"fields": []
},
"right": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Elbow Progress",
"color": "#af2437",
"show": true
},
{
"key": "NT:/AdvantageKit/RealOutputs/Arm/Wrist Progress",
"color": "#80588e",
"show": true
},
{
"key": "NT:/AdvantageKit/ArmInputs/ElbowVelocityRadPerSec",
"color": "#e48b32",
"show": false
}
]
}
},
"title": "Line Graph"
},
{
"type": 1,
"legends": {
"left": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/ArmInputs/WristVelocityRadPerSec",
"color": "#2b66a2",
"show": true
},
{
"key": "NT:/AdvantageKit/ArmInputs/ElbowVelocityRadPerSec",
"color": "#e5b31b",
"show": true
}
]
},
"discrete": {
"fields": []
},
"right": {
"lockedRange": null,
"unitConversion": {
"type": null,
"factor": 1
},
"fields": [
{
"key": "NT:/AdvantageKit/ArmInputs/ElbowAppliedVolts",
"color": "#af2437",
"show": false
},
{
"key": "NT:/AdvantageKit/ArmInputs/WristAppliedVolts",
"color": "#80588e",
"show": false
}
]
}
},
"title": "Line Graph"
}
]
}
2 changes: 1 addition & 1 deletion .pathplanner/settings.json
Original file line number Diff line number Diff line change
Expand Up @@ -8,5 +8,5 @@
"defaultMaxAccel": 3.0,
"defaultMaxAngVel": 540.0,
"defaultMaxAngAccel": 720.0,
"maxModuleSpeed": 4.5
"maxModuleSpeed": 5.0
}
Loading

0 comments on commit 9374282

Please sign in to comment.