DriveCircleLogging.java

// simple autonomous program that drives bot in a circle then ends.
// this code assumes it will end before the period is over but if the period ended while
// still driving, this code will just stop. Stops after 5 seconds or on touch sensor button.
// This sample shows the use of logging to a file for debugging purposes.

package org.firstinspires.ftc.teamcode;

import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.hardware.TouchSensor;

@Autonomous(name="Drive Circle Logging", group="Exercises")
//@Disabled
public class DriveCircleLogging extends LinearOpMode
{
    DcMotor     leftMotor;
    DcMotor     rightMotor;
    TouchSensor touch;

    // Use class constructor to initialize logging system.
    public DriveCircleLogging() throws Exception
    {
        Logging.setup();
        Logging.log("Starting Drive Circle Logging");
    }

    // called when init button is pressed.
    @Override
    public void runOpMode() throws InterruptedException
    {
        leftMotor = hardwareMap.dcMotor.get("left_motor");
        rightMotor = hardwareMap.dcMotor.get("right_motor");
        
        leftMotor.setDirection(DcMotor.Direction.REVERSE);

        touch = hardwareMap.touchSensor.get("touch_sensor");

        telemetry.addData("Mode", "waiting");
        telemetry.update();

        Logging.log("waiting for start");

        // wait for start button.

        waitForStart();

        telemetry.addData("Mode", "running");
        telemetry.update();

        Logging.log("running");

        sleep(1000);

        // set power levels 75% left and 10% right to drive in an arc to the right.

        leftMotor.setPower(0.75);
        rightMotor.setPower(0.20);

        resetStartTime();

        // drive until touch sensor button pressed or 5 seconds passes.

        boolean stopFlag = false;

        while (opModeIsActive() && !stopFlag)
        {
            if (getRuntime() > 5)
            {
                Logging.log("timeout");
                stopFlag = true;
            }

            if (touch.isPressed())
            {
                Logging.log("button touched");
                stopFlag = true;
            }

            idle();
        }

        Logging.log("out of while loop");

        // turn the motors off.

        rightMotor.setPower(0);
        leftMotor.setPower(0);

        // demonstrate using format specifiers.

        int i = 3;
        double d = 3.75;

        Logging.log("stopFlag=%b, i=%d, d=%f", stopFlag, i, d);

        Logging.log("done");
    }
}