FRC-2017-Robot-Java/AutonStrategyPosCGear.java at master · SCOTS-Bots/FRC-2017-Robot-Java · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
package org.scotsbots.robotbase.utils;

import org.scotsbots.robotbase.AutonStrategy;
import org.scotsbots.robotbase.Robot;

public class AutonStrategyPosCGear extends AutonStrategy
{
	public int time = 0;

	@Override
	public void intialize()
	{
		time = 0;
	}

	@Override
	public void update()
	{
		time++;
		if(time >= 0 && time <= 30)
		{
			Robot.bot.drivetrain.drive(-0.4, 0);
		}
		else if(time >= 31 && time <= 60)
		{
			Robot.bot.drivetrain.drive(0, 0);
		}}
		/**
		else if(time >= 60 && time <= 190)
		{
			Robot.bot.drivetrain.drive(-0.7, 0);
		}
		else if(time >= 191 && time <= 215)
		{
			Robot.bot.drivetrain.tankDrive(0.7, -0.7);
		}
		else if(time >= 216 && time <=280)
		{
			Robot.bot.drivetrain.drive(-0.35, 0);
		}
		else if(time > 280 && time <= 350)
		{
			if(Robot.bot instanceof RobotHardwarePrototypeBot)
			{
				RobotHardwarePrototypeBot protobot = (RobotHardwarePrototypeBot)Robot.bot;
				protobot.intake.set(1);
			}

			if(Robot.bot instanceof RobotHardwareCompbot)
			{
				RobotHardwareCompbot protobot = (RobotHardwareCompbot)Robot.bot;
				protobot.intake.set(1);
			}
		}
		else
		{
			Robot.bot.drivetrain.drive(0, 0);

			if(Robot.bot instanceof RobotHardwarePrototypeBot)
			{
				RobotHardwarePrototypeBot protobot = (RobotHardwarePrototypeBot)Robot.bot;
				protobot.intake.set(0);
			}

			if(Robot.bot instanceof RobotHardwareCompbot)
			{
				RobotHardwareCompbot protobot = (RobotHardwareCompbot)Robot.bot;
				protobot.intake.set(0);
			}
		}
	}
*/
	@Override
	public String getName()
	{
		return "Position C Gear";
	}

}