TimeCrafters/FTC_2022
1
0
Fork 0
mirror of https://github.com/TimeCrafters/FTC_2022 synced 2025-12-15 15:32:35 +00:00
Code Issues Packages Projects Releases Wiki Activity

camera servo sate added

Browse Source
This commit is contained in:
SpencerPiha
2022-11-11 14:52:45 -06:00
parent f5b6a750db
commit 69f5a5c785
1 changed files with 26 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
TeamCode/src/main/java/org/timecrafters/Autonomous/States/ServoCameraRotate.java Normal file
View File

@@ -0,0 +1,26 @@
package org.timecrafters.Autonomous.States;
import org.cyberarm.engine.V2.CyberarmState;
import org.timecrafters.testing.states.PhoenixBot1;
public class ServoCameraRotate extends CyberarmState {
private final boolean stateDisabled;
PhoenixBot1 robot;
private double ServoPosition;
public ServoCameraRotate(PhoenixBot1 robot, String groupName, String actionName) {
this.stateDisabled = !robot.configuration.action(groupName, actionName).enabled;
this.robot = robot;
this.ServoPosition = robot.configuration.variable(groupName, actionName, "ServoPosition").value();
}
@Override
public void exec() {
if (stateDisabled) {
setHasFinished(true);
} else {
robot.CameraServo.setPosition(ServoPosition);
setHasFinished(true);
}
}
}