package org.firstinspires.ftc.team7316.modes.test_opmodes;

import com.qualcomm.robotcore.eventloop.opmode.Autonomous;

import org.firstinspires.ftc.team7316.modes.AutoBaseOpMode;
import org.firstinspires.ftc.team7316.util.Hardware;
import org.firstinspires.ftc.team7316.util.Scheduler;
import org.firstinspires.ftc.team7316.util.commands.AutoCodes;
import org.firstinspires.ftc.team7316.util.commands.drive.DriveForTime;
import org.firstinspires.ftc.team7316.util.commands.drive.distance.DriveDistance;
import org.firstinspires.ftc.team7316.util.commands.drive.turn.TurnGyroPID;
import org.firstinspires.ftc.team7316.util.commands.flow.SequentialCommand;
import org.firstinspires.ftc.team7316.util.commands.flow.SimultaneousKeyCommand;
import org.firstinspires.ftc.team7316.util.commands.intake.MoveIntakeArm;
import org.firstinspires.ftc.team7316.util.commands.intake.RunIntake;

/**
 * Created by jerry on 2/8/18.
 */

public class SimultaneousKeyTest extends AutoBaseOpMode {
    @Override
    public void onInit() {
//        Scheduler.instance.add(
//            new SequentialCommand(
//                new TurnGyroPID(90),
//                new SequentialCommand(
//                    new DriveForTime(0.4, 0, 1),
//                    new SimultaneousKeyCommand(
//                            new DriveDistance(10),
//                            new RunIntake(-0.7)
//                    ),
//                    new SimultaneousKeyCommand(
//                            new DriveDistance(-10),
//                            new RunIntake(-0.7)
//                    ),
//                    new TurnGyroPID(180)
//                ),
//                new SimultaneousKeyCommand(
//                        new TurnGyroPID(0),
//                        new RunIntake(0.44)
//                ),
//                new DriveDistance(-10)
//            )
//        );
        Scheduler.instance.add(AutoCodes.closeMultiglyph(false));
    }

    @Override
    public void onLoop() {
        Hardware.log("fatty", "fatty");
    }
}
