@echo off
REM Generate TeleOp.java OpMode
setlocal

set "PROJECT_DIR=%~1"

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

endlocal
exit /b 0