KeshavAnandCode/FTCDecodeMain
1
0
Fork 0
Code Issues Pull Requests 1 Actions Packages Projects Releases Wiki Activity

last edit

Browse Source
This commit is contained in:
DanTheMan-byte
2026-01-28 15:36:44 -06:00
parent 5d0a569f82
commit 641d947ec6
1 changed files with 11 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Spindexer.java
View File

@@ -255,17 +255,17 @@ public class Spindexer {
private void moveSpindexerToPos(double pos) {
robot.spin1.setPosition(pos);
robot.spin2.setPosition(1-pos);
double currentPos = servos.getSpinPos();
if (!servos.spinEqual(pos) && Math.abs(prevPos - currentPos) <= 0){
if (currentPos > pos){
robot.spin1.setPosition(servos.getSpinPos() + 0.05);
robot.spin2.setPosition(1 - servos.getSpinPos() - 0.05);
} else {
robot.spin1.setPosition(servos.getSpinPos() - 0.05);
robot.spin2.setPosition(1 - servos.getSpinPos() + 0.05);
}
}
prevPos = currentPos;
// double currentPos = servos.getSpinPos();
// if (!servos.spinEqual(pos) && Math.abs(prevPos - currentPos) <= 0){
// if (currentPos > pos){
// robot.spin1.setPosition(servos.getSpinPos() + 0.05);
// robot.spin2.setPosition(1 - servos.getSpinPos() - 0.05);
// } else {
// robot.spin1.setPosition(servos.getSpinPos() - 0.05);
// robot.spin2.setPosition(1 - servos.getSpinPos() + 0.05);
// }
// }
// prevPos = currentPos;
}
public void stopSpindexer() {