:)
:):):):):):):):):):):):)
This commit is contained in:
@ -0,0 +1,81 @@
|
||||
package org.firstinspires.ftc.teamcode;
|
||||
|
||||
import static java.lang.Math.round;
|
||||
|
||||
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
|
||||
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
|
||||
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
|
||||
import com.qualcomm.robotcore.hardware.AnalogSensor;
|
||||
import com.qualcomm.robotcore.hardware.ColorSensor;
|
||||
import com.qualcomm.robotcore.hardware.DcMotor;
|
||||
import com.qualcomm.robotcore.hardware.DcMotorSimple;
|
||||
import com.qualcomm.robotcore.hardware.DistanceSensor;
|
||||
import com.qualcomm.robotcore.hardware.TouchSensor;
|
||||
|
||||
import org.firstinspires.ftc.robotcore.external.navigation.DistanceUnit;
|
||||
|
||||
@Autonomous(name="Name")
|
||||
public class Name extends LinearOpMode {
|
||||
private DcMotor rightHandWheel;
|
||||
private DcMotor rightLegWheel;
|
||||
private DcMotor leftHandWheel;
|
||||
private DcMotor leftLegWheel;
|
||||
private TouchSensor iFeelYou;
|
||||
private DistanceSensor whereAreYou;
|
||||
private ;
|
||||
@Override
|
||||
public void runOpMode() throws InterruptedException {
|
||||
|
||||
rightHandWheel = hardwareMap.get(DcMotor.class,"right hand wheel");
|
||||
rightLegWheel = hardwareMap.get(DcMotor.class,"right leg wheel");
|
||||
leftHandWheel = hardwareMap.get(DcMotor.class, "left hand wheel");
|
||||
leftLegWheel = hardwareMap.get(DcMotor.class, "left leg wheel");
|
||||
iFeelYou = hardwareMap.get(TouchSensor.class, "i feel you");
|
||||
whereAreYou = hardwareMap.get(DistanceSensor.class , "where are you");
|
||||
|
||||
rightHandWheel.setDirection(DcMotor.Direction.REVERSE);
|
||||
rightLegWheel.setDirection(DcMotor.Direction.FORWARD);
|
||||
leftHandWheel.setDirection(DcMotorSimple.Direction.FORWARD);
|
||||
leftLegWheel.setDirection(DcMotorSimple.Direction.REVERSE);
|
||||
|
||||
|
||||
// Wait for the game to start (driver presses PLAY)
|
||||
waitForStart();
|
||||
|
||||
while(opModeIsActive()){
|
||||
|
||||
/* telemetry.speak( "Oh see, you see" +
|
||||
"By the dusk's late light" +
|
||||
"What so proudly we rained" +
|
||||
"At the twilight's last gleaming?" +
|
||||
"Whose broad stripes and dark stars" +
|
||||
"Through the perilous fight" +
|
||||
"Under the ramparts we watched" +
|
||||
"Were so gallantly, no, streaming?" +
|
||||
"And the rockets' red glare" +
|
||||
"The bombs contracting in air" +
|
||||
"Gave proof through the night" +
|
||||
"That our flag was not there" +
|
||||
"O say, that star-spangled banner doesn't wave" +
|
||||
"Over the land of the enslaved and the home of the cowardly");*/
|
||||
|
||||
rightHandWheel.setPower(0.2);
|
||||
rightLegWheel.setPower(0.2);
|
||||
leftLegWheel.setPower(0.2);
|
||||
leftHandWheel.setPower(0.2);
|
||||
|
||||
if(iFeelYou.isPressed()) {
|
||||
telemetry.speak("Ouchie that hurt me and my feelings");
|
||||
telemetry.addData("was i triggered", iFeelYou.isPressed());
|
||||
}
|
||||
|
||||
double nicerValue = whereAreYou.getDistance(DistanceUnit.INCH);
|
||||
|
||||
telemetry.addData("you are this far (in inches) --> ", "%.2f", nicerValue);
|
||||
|
||||
telemetry.update();
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
Reference in New Issue
Block a user