forked from FIRST-Tech-Challenge/FtcRobotController
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathIntakeTest.java
More file actions
37 lines (29 loc) · 1.25 KB
/
IntakeTest.java
File metadata and controls
37 lines (29 loc) · 1.25 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
package org.firstinspires.ftc.teamcode;
import com.acmerobotics.dashboard.FtcDashboard;
import com.acmerobotics.dashboard.config.Config;
import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
import com.arcrobotics.ftclib.controller.PIDController;
import com.arcrobotics.ftclib.hardware.motors.Motor;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
import org.firstinspires.ftc.robotcore.external.Telemetry;
@Config
@TeleOp(name = "IntakeTest")
public class IntakeTest extends LinearOpMode {
private Motor intakeLeft;
private Motor intakeRight;
private Telemetry mTelemetry = new MultipleTelemetry(telemetry, FtcDashboard.getInstance().getTelemetry());
@Override
public void runOpMode() throws InterruptedException {
intakeLeft = new Motor(hardwareMap, "intakeLeft");
intakeRight = new Motor(hardwareMap, "intakeRight");
intakeLeft.resetEncoder();
intakeRight.resetEncoder();
waitForStart();
while (opModeIsActive()) {
mTelemetry.addData("leftPos", intakeLeft.encoder.getDistance());
mTelemetry.addData("rightPos", intakeRight.encoder.getDistance());
mTelemetry.update();
}
}
}