Odometry Working haha

This commit is contained in:
Aarav Shah
2020-03-06 18:46:45 -07:00
parent b3558887cc
commit 3c0b92a4ac
6 changed files with 57 additions and 31 deletions
@@ -29,15 +29,15 @@ public class AutoPath1FromCenter extends SequentialCommandGroup {
addCommands( new Wait(m_drive, 0, 1),
//shoot pre-loaded 3 balls
new GotoCoordinates(m_drive, m_pneumatics, 75, 44, -90),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 75, 44, -90),
//Start Intake Ball 1
new GotoCoordinates(m_drive, m_pneumatics, 0, 12),
new GotoCoordinates(m_drive, m_pneumatics, 0, 28),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 0, 12),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 0, 28),
//Start Intake Ball 2
new GotoCoordinates(m_drive, m_pneumatics, 0, 8),
new GotoCoordinates(m_drive, m_pneumatics, 0, 28),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 0, 8),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 0, 28),
//Start Intake Ball 3
new GotoCoordinates(m_drive, m_pneumatics, 0, 8),
new GotoCoordinatesRobotRelative(m_drive, m_pneumatics, 0, 8),
new Wait(m_drive, 0, 2)
//Shoot 3 Balls
);