Team4388/2018-Robot
1
0
Fork 0
mirror of https://github.com/Team4388/2018-Robot.git synced 2026-06-09 00:38:04 -06:00
Code Issues Packages Projects Releases Wiki Activity

Auton And FMS Update

Browse Source
This commit is contained in:
lukesta182
2018-03-06 18:46:18 -07:00
parent f3591476b1
commit 47b48b2e42
3 changed files with 83 additions and 35 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/org/usfirst/frc4388/robot/Robot.java
+36 -35
View File
@@ -123,16 +123,16 @@ public class Robot extends IterativeRobot
RRautonTaskChooser.addDefault("Choose RR Program", new CrossTheBaseLine());
RRautonTaskChooser.addObject("1", new CrossTheBaseLine());
RRautonTaskChooser.addObject("Left to Right Switch", new LeftStartRightScore());
RRautonTaskChooser.addObject("2", new CrossTheBaseLine());
RRautonTaskChooser.addObject("Center to Left Switch", new CenterLeft());
RRautonTaskChooser.addObject("Center to Right Switch", new CenterRight());
RRautonTaskChooser.addObject("3", new CrossTheBaseLine());
RRautonTaskChooser.addObject("Right to Right Switch", new RightSwitchAuton());
RRautonTaskChooser.addObject("Right to Left Switch", new RightStartLeftScore());
RRautonTaskChooser.addObject("Scale3", new ScaleFrom3());
SmartDashboard.putData("RRAuton Task", RRautonTaskChooser);
@@ -145,14 +145,14 @@ public class Robot extends IterativeRobot
RLautonTaskChooser.addDefault("Choose RL Program", new CrossTheBaseLine());
RLautonTaskChooser.addObject("1", new CrossTheBaseLine());
RLautonTaskChooser.addObject("Left to Right Switch", new LeftStartRightScore());
RLautonTaskChooser.addObject("2", new CrossTheBaseLine());
RLautonTaskChooser.addObject("Center to Left Switch", new CenterLeft());
RLautonTaskChooser.addObject("Center to Right Switch", new CenterRight());
RLautonTaskChooser.addObject("3", new CrossTheBaseLine());
RLautonTaskChooser.addObject("Right to Right Switch", new RightSwitchAuton());
RLautonTaskChooser.addObject("Right to Left Switch", new RightStartLeftScore());
@@ -168,14 +168,14 @@ public class Robot extends IterativeRobot
LLautonTaskChooser.addDefault("Choose LL Program", new CrossTheBaseLine());
LLautonTaskChooser.addObject("1", new CrossTheBaseLine());
LLautonTaskChooser.addObject("Left to Right Switch", new LeftStartRightScore());
LLautonTaskChooser.addObject("2", new CrossTheBaseLine());
LLautonTaskChooser.addObject("Center to Left Switch", new CenterLeft());
LLautonTaskChooser.addObject("Center to Right Switch", new CenterRight());
LLautonTaskChooser.addObject("3", new CrossTheBaseLine());
LLautonTaskChooser.addObject("Right to Right Switch", new RightSwitchAuton());
LLautonTaskChooser.addObject("Right to Left Switch", new RightStartLeftScore());
@@ -189,15 +189,13 @@ public class Robot extends IterativeRobot
LRautonTaskChooser = new SendableChooser<Command>();
LRautonTaskChooser.addDefault("Choose LR Program", new CrossTheBaseLine());
LRautonTaskChooser.addObject("1", new CrossTheBaseLine());
LRautonTaskChooser.addObject("Left to Right Switch", new LeftStartRightScore());
LRautonTaskChooser.addObject("2", new CrossTheBaseLine());
LRautonTaskChooser.addObject("Center to Left Switch", new CenterLeft());
LRautonTaskChooser.addObject("Center to Right Switch", new CenterRight());
LRautonTaskChooser.addObject("3", new CrossTheBaseLine());
LRautonTaskChooser.addObject("Right to Right Switch", new RightSwitchAuton());
LRautonTaskChooser.addObject("Right to Left Switch", new RightStartLeftScore());
@@ -251,28 +249,31 @@ public class Robot extends IterativeRobot
String gameData;
gameData = DriverStation.getInstance().getGameSpecificMessage();
if(gameData.length() > 0)
{
if(gameData.charAt(0) == 'L')
{
if(gameData.charAt(1) == 'L')
{
if (LLautonomousCommand != null) LLautonomousCommand.start();
} else {
if (LRautonomousCommand != null) LRautonomousCommand.start();
}
}
} else {
if(gameData.charAt(1) == 'L')
{
if (RLautonomousCommand != null) RLautonomousCommand.start();
} else {
if (RRautonomousCommand != null) RRautonomousCommand.start();
}
}
}
if (gameData.length() > 0) {
if (gameData.charAt(0) == 'L') {
if (gameData.charAt(1) == 'L') {
if (LLautonomousCommand != null) {
LLautonomousCommand.start();
}
} else {
if (LRautonomousCommand != null) {
LRautonomousCommand.start();
}
}
} else {
if (gameData.charAt(1) == 'L') {
if (RLautonomousCommand != null) {
RLautonomousCommand.start();
}
} else {
if (RRautonomousCommand != null) {
RRautonomousCommand.start();
}
}
}
}
}
public void autonomousPeriodic() {
Scheduler.getInstance().run();