package robot.opmodes;

import robot.hardware.MecanumDrive;
import robot.subsystems.Drive;

// Uncomment when deploying to robot:
// import com.qualcomm.robotcore.eventloop.opmode.OpMode;
// import com.qualcomm.robotcore.eventloop.opmode.TeleOp;

/**
 * Main TeleOp OpMode.
 * 
 * DEPLOYMENT NOTE:
 * Uncomment FTC imports and @TeleOp annotation when ready to deploy.
 * Keep commented during development/testing on PC.
 */
// @TeleOp(name="Main TeleOp")
public class TeleOp /* extends OpMode */ {
    
    private Drive drive;
    
    // Uncomment when deploying:
    // @Override
    public void init() {
        // Uncomment when deploying:
        // MecanumDrive hardware = new MecanumDrive(hardwareMap);
        // drive = new Drive(hardware);
        //
        // telemetry.addData("Status", "Initialized");
        // telemetry.update();
    }
    
    // Uncomment when deploying:
    // @Override
    public void loop() {
        // Uncomment when deploying:
        // // Get gamepad inputs
        // double forward = -gamepad1.left_stick_y;  // Inverted
        // double strafe = gamepad1.left_stick_x;
        // double rotate = gamepad1.right_stick_x;
        //
        // // Drive the robot
        // drive.drive(forward, strafe, rotate);
        //
        // // Show telemetry
        // telemetry.addData("Forward", "%.2f", forward);
        // telemetry.addData("Strafe", "%.2f", strafe);
        // telemetry.addData("Rotate", "%.2f", rotate);
        // telemetry.update();
    }
    
    // Uncomment when deploying:
    // @Override
    public void stop() {
        // Uncomment when deploying:
        // if (drive != null) {
        //     drive.stop();
        // }
    }
}