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

Slowing the button rotation on TeleOP, Sprint 3 TeleOP, take 5. (CAW caw caw CAWAW awcaw CAW)

Browse Source
This commit is contained in:
Sodi
2022-10-29 12:04:10 -05:00
parent 4a698f2f07
commit 02c023b19a
1 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java
View File

@@ -153,14 +153,14 @@ public class PrototypeTeleOPState extends CyberarmState {
RobotRotation = robot.imu.getAngularOrientation().firstAngle;
RotationTarget = -180;
if (RobotRotation < 0 && RobotRotation > -177) {
drivePower = (1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) + 0.3;
drivePower = (1 * ((RobotRotation) - (RotationTarget))/180) + 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
robot.frontRightDrive.setPower(-drivePower);
}
if (RobotRotation > 0) {
drivePower = (-1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) - 0.3;
drivePower = (-1 * ((RobotRotation) - (RotationTarget))/180) - 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
@@ -179,14 +179,14 @@ public class PrototypeTeleOPState extends CyberarmState {
RobotRotation = robot.imu.getAngularOrientation().firstAngle;
RotationTarget = 0;
if (RobotRotation < -3) {
drivePower = (-1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) - 0.3;
drivePower = (-1 * ((RobotRotation) - (RotationTarget))/180) - 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
robot.frontRightDrive.setPower(-drivePower);
}
if (RobotRotation > 3) {
drivePower = (1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) + 0.3;
drivePower = (1 * ((RobotRotation) - (RotationTarget))/180) + 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
@@ -204,14 +204,14 @@ public class PrototypeTeleOPState extends CyberarmState {
RobotRotation = robot.imu.getAngularOrientation().firstAngle;
RotationTarget = 135;
if (RobotRotation > -45 && RobotRotation < 132) {//CCW
drivePower = (-1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) - 0.3;
drivePower = (-1 * ((RobotRotation) - (RotationTarget))/180) - 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
robot.frontRightDrive.setPower(-drivePower);
}
if (RobotRotation < -45 || RobotRotation > 138) {//CW
drivePower = (1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) + 0.3;
drivePower = (1 * ((RobotRotation) - (RotationTarget))/180) + 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
@@ -229,14 +229,14 @@ public class PrototypeTeleOPState extends CyberarmState {
RobotRotation = robot.imu.getAngularOrientation().firstAngle;
RotationTarget = -135;
if (RobotRotation < 45 && RobotRotation > -132) {//CCW
drivePower = (1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) + 0.3;
drivePower = (1 * ((RobotRotation) - (RotationTarget))/180) + 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);
robot.frontRightDrive.setPower(-drivePower);
}
if (RobotRotation > 45 || RobotRotation < -138) {//CW
drivePower = (-1 * (Math.abs(RobotRotation) - Math.abs(RotationTarget))/180) - 0.3;
drivePower = (-1 * ((RobotRotation) - (RotationTarget))/180) - 0.3;
robot.backLeftDrive.setPower(drivePower);
robot.backRightDrive.setPower(-drivePower);
robot.frontLeftDrive.setPower(drivePower);