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

last edit

Browse Source
This commit is contained in:
DanTheMan committed 2026-01-28 15:36:44 -06:00
1 parent 5d0a569f82
commit 641d947ec6
1 file changed
+11 -11
Download Patch File Download Diff File Expand all files Collapse all files
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Spindexer.java
+11 -11
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() {