mirror of
https://github.com/TimeCrafters/FTC_2022
synced 2025-12-15 14:22:34 +00:00
Added Horizontal Encoder, Renamed "OdometerEncoder" to "OdometerEncoderRight" and made sure there weren't any issues when building (everything is good)
This commit is contained in:
@@ -77,7 +77,7 @@ public class CollectorDistanceState extends CyberarmState {
|
|||||||
robot.backLeftDrive.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
robot.backLeftDrive.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
robot.OdometerEncoderRight.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
robot.OdometerEncoderRight.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
robot.OdometerEncoderLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
robot.OdometerEncoderLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
robot.OdometerEncoderHorizonatal.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
robot.OdometerEncoderHorizontal.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
|
|
||||||
robot.frontRightDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.frontRightDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
robot.frontLeftDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.frontLeftDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
@@ -85,7 +85,7 @@ public class CollectorDistanceState extends CyberarmState {
|
|||||||
robot.backLeftDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.backLeftDrive.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
robot.OdometerEncoderRight.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.OdometerEncoderRight.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
robot.OdometerEncoderLeft.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.OdometerEncoderLeft.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
robot.OdometerEncoderHorizonatal.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
robot.OdometerEncoderHorizontal.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
|
|
||||||
|
|
||||||
robot.collectorLeft.setPower(1);
|
robot.collectorLeft.setPower(1);
|
||||||
|
|||||||
@@ -27,7 +27,7 @@ public class TopArm extends CyberarmState {
|
|||||||
|
|
||||||
@Override
|
@Override
|
||||||
public void start() {
|
public void start() {
|
||||||
up = robot.HighRiseMotor.getCurrentPosition() < UpperRiserLeftPos;
|
up = robot.ArmMotor.getCurrentPosition() < UpperRiserLeftPos;
|
||||||
}
|
}
|
||||||
|
|
||||||
@Override
|
@Override
|
||||||
|
|||||||
@@ -46,7 +46,7 @@ public class PhoenixBot1 {
|
|||||||
|
|
||||||
public Rev2mDistanceSensor collectorDistance, /*downSensor, */leftPoleDistance, rightPoleDistance;
|
public Rev2mDistanceSensor collectorDistance, /*downSensor, */leftPoleDistance, rightPoleDistance;
|
||||||
|
|
||||||
public DcMotor frontLeftDrive, frontRightDrive, backLeftDrive, backRightDrive, OdometerEncoder, OdometerEncoderLeft, ArmMotor, armMotorEncoder;
|
public DcMotor frontLeftDrive, frontRightDrive, backLeftDrive, backRightDrive, OdometerEncoderRight, OdometerEncoderLeft, OdometerEncoderHorizontal, ArmMotor, armMotorEncoder;
|
||||||
|
|
||||||
public CRServo collectorLeft, collectorRight;
|
public CRServo collectorLeft, collectorRight;
|
||||||
|
|
||||||
@@ -174,11 +174,11 @@ public class PhoenixBot1 {
|
|||||||
|
|
||||||
// Dead Wheel encoder for driving
|
// Dead Wheel encoder for driving
|
||||||
|
|
||||||
OdometerEncoder = engine.hardwareMap.dcMotor.get("odometerEncoderR");
|
OdometerEncoderRight = engine.hardwareMap.dcMotor.get("odometerEncoderR");
|
||||||
|
|
||||||
OdometerEncoder.setDirection(DcMotorSimple.Direction.REVERSE);
|
OdometerEncoderRight.setDirection(DcMotorSimple.Direction.REVERSE);
|
||||||
OdometerEncoder.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
OdometerEncoderRight.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
OdometerEncoder.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
OdometerEncoderRight.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
|
|
||||||
OdometerEncoderLeft = engine.hardwareMap.dcMotor.get("odometerEncoderL");
|
OdometerEncoderLeft = engine.hardwareMap.dcMotor.get("odometerEncoderL");
|
||||||
|
|
||||||
@@ -186,6 +186,14 @@ public class PhoenixBot1 {
|
|||||||
OdometerEncoderLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
OdometerEncoderLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
OdometerEncoderLeft.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
OdometerEncoderLeft.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
|
|
||||||
|
OdometerEncoderHorizontal = engine.hardwareMap.dcMotor.get("odometerEncoderH");
|
||||||
|
|
||||||
|
OdometerEncoderHorizontal.setDirection(DcMotorSimple.Direction.REVERSE);
|
||||||
|
OdometerEncoderHorizontal.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
|
||||||
|
OdometerEncoderHorizontal.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
// HighRiserLeft.setDirection(Servo.Direction.REVERSE);
|
// HighRiserLeft.setDirection(Servo.Direction.REVERSE);
|
||||||
// HighRiserRight.setDirection(Servo.Direction.FORWARD);
|
// HighRiserRight.setDirection(Servo.Direction.FORWARD);
|
||||||
|
|||||||
@@ -61,6 +61,7 @@ public class PhoenixTeleOPState extends CyberarmState {
|
|||||||
engine.telemetry.addData("Right Pole Distance", robot.rightPoleDistance.getDistance(DistanceUnit.MM));
|
engine.telemetry.addData("Right Pole Distance", robot.rightPoleDistance.getDistance(DistanceUnit.MM));
|
||||||
engine.telemetry.addData("Odometer Encoder, Right", robot.OdometerEncoderRight.getCurrentPosition());
|
engine.telemetry.addData("Odometer Encoder, Right", robot.OdometerEncoderRight.getCurrentPosition());
|
||||||
engine.telemetry.addData("Odometer Encoder, Left", robot.OdometerEncoderLeft.getCurrentPosition());
|
engine.telemetry.addData("Odometer Encoder, Left", robot.OdometerEncoderLeft.getCurrentPosition());
|
||||||
|
engine.telemetry.addData("Odometer Encoder, Horizontal", robot.OdometerEncoderHorizontal.getCurrentPosition());
|
||||||
}
|
}
|
||||||
|
|
||||||
@Override
|
@Override
|
||||||
|
|||||||
Reference in New Issue
Block a user