diff --git a/ftc2024-carlike.java b/ftc2024-carlike.java index b3c3f2a..3309ca1 100644 --- a/ftc2024-carlike.java +++ b/ftc2024-carlike.java @@ -26,6 +26,7 @@ import org.firstinspires.ftc.robotcore.external.navigation.Velocity; public class Werobot_FTC2024_carlike extends LinearOpMode { private DcMotor rm; private DcMotor lm; + private DcMotor moissoneuse; private IMU imu; private double helloexp(double t){ return (Math.exp(5*t)-1)/(Math.exp(5)-1); @@ -41,6 +42,7 @@ public class Werobot_FTC2024_carlike extends LinearOpMode { boolean already_a = false; telemetry.addData("Status", "Initialized"); telemetry.update(); + boolean already_b = false; lm = hardwareMap.get(DcMotor.class, "blm"); rm = hardwareMap.get(DcMotor.class, "brm"); @@ -127,6 +129,19 @@ public class Werobot_FTC2024_carlike extends LinearOpMode { lm.setPower(lpower); rm.setPower(rpower); + if(gamepad1.b && !already_b){ + already_b=!already_b; + if(moissoneuse.getPower == 0){ + moissoneuse.setPower(1); + }else{ + moissoneuse.setPower(0); + } + } + if(!gamepad1.b && already_b){ + already_b=!already_b; + } + + telemetry.addData("x",x); telemetry.addData("y",y); telemetry.addData("lpow",lpower);