Skip to content
This repository was archived by the owner on Aug 31, 2024. It is now read-only.

Added Backboard Alignment Method - needs to be implemented in teleop #114

Closed
wants to merge 7 commits into from
Closed
Changes from 1 commit
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Prev Previous commit
Distance Test Formatting before removal
DragonDev07 committed Mar 15, 2024

Verified

This commit was created on GitHub.com and signed with GitHub’s verified signature.
commit e5d958c5aa64b8ab7ec261a7f26ce55effb2457d
Original file line number Diff line number Diff line change
@@ -49,9 +49,9 @@ public void loop() {


if (gamepad1.dpad_left) {
aligning = true;
aligning = true;
}
if (aligning){
if (aligning) {
alignWithBackboard(19, 2);
}
if (gamepad1.dpad_right) {
@@ -75,11 +75,6 @@ private void alignWithBackboard(int dist, int tolerance) {
int distPlus = dist + tolerance;
int distMinus = dist - tolerance;

if (robot.distRight.getDistance(DistanceUnit.CM) >= distMinus && robot.distRight.getDistance(DistanceUnit.CM )<= distMinus && robot.distLeft.getDistance(DistanceUnit.CM) >= distMinus && robot.distLeft.getDistance(DistanceUnit.CM )<= distMinus){

}


if (distPlus >= robot.distRight.getDistance(DistanceUnit.CM) && robot.distRight.getDistance(DistanceUnit.CM) >= distMinus) {
frontRightPower = 0;
backRightPower = 0;
@@ -110,6 +105,7 @@ private void alignWithBackboard(int dist, int tolerance) {
backLeftPower = 0.2;
backRightPower = -0.2;
}

if (distPlus >= robot.distRight.getDistance(DistanceUnit.CM) && robot.distRight.getDistance(DistanceUnit.CM) >= distMinus && distPlus >= robot.distLeft.getDistance(DistanceUnit.CM) && robot.distLeft.getDistance(DistanceUnit.CM) >= distMinus) {
frontLeftPower = 0;
backLeftPower = 0;
@@ -144,5 +140,4 @@ private void alignWithBackboard(int dist, int tolerance) {


}

}