/* 
 * Copyright (c) 2016 RobotsByTheC. All rights reserved.
 *
 * Open Source Software - may be modified and shared by FRC teams. The code must
 * be accompanied by the BSD license file in the root directory of the project.
 */
package org.usfirst.frc.team2084.CMonster2016.commands;

import java.util.concurrent.Future;

import edu.wpi.first.wpilibj.command.CommandGroup;
import edu.wpi.first.wpilibj.command.WaitCommand;
import jaci.pathfinder.Trajectory;

/**
 * Autonomous mode that drives under the low bar and shoots using the vision
 * system.
 * 
 * @author Ben Wolsieffer
 */
public class CrossShootAutonomous extends CommandGroup {

    public static final double MOVEMENT_WAIT_TIME = 2;

    public static final String ROTATION_KEY = "Auto rotation angle";

    public CrossShootAutonomous(Future<Trajectory[]> trajectory) {
        // Get the robot and arm into a position where the camera can see the
        // goal
        addSequential(new CrossAutonomous());
        // Make sure the ball is out of the shooter wheels
        addParallel(new SetShooterSpeed(-1000));
        addSequential(new WaitCommand(0.5));
        addSequential(new AimAndFire());
        addSequential(new StopShooter());
    }

    /**
     * 
     */
    @Override
    protected void initialize() {
    }
}

@@ -327,38 +327,229 @@
 ort 
-edu.wpi.first.wpilibj.command.
+org.usfirst.frc.team2084.CMonster2016.subsystems.ArmSubsystem;%0A%0Aimport edu.wpi.first.wpilibj.command.CommandGroup;%0Aimport edu.wpi.first.wpilibj.command.ParallelCommandGroup;%0Aimport edu.wpi.first.wpilibj.command.Sequential
 Comm
@@ -1145,24 +1145,196 @@
 new 
-CrossAutonomous(
+ParallelCommandGroup(%0A                new SequentialCommandGroup(new WaitCommand(MOVEMENT_WAIT_TIME), new PathFollower(trajectory)),%0A                new SetArmAngle(ArmSubsystem.AIM_ANGLE)
 ));%0A

Revert "Restore old autonomous code."