Added Path to Intake 3 balls in 6 ball Autonomous

This commit is contained in:
Aarav Shah
2020-02-29 11:37:35 -07:00
parent f7d8d41445
commit a95e43d02d
3 changed files with 19 additions and 13 deletions
@@ -44,7 +44,7 @@ public class GotoCoordinates extends SequentialCommandGroup {
addCommands( new TurnDegrees(m_drive, m_currentAngle),
new Wait(m_drive, 1),
new Wait(m_drive, 0.1),
new DriveStraightToPositionPID(m_drive, m_hypotDist),
new TurnDegrees(m_drive, m_endAngle - m_currentAngle));
}
@@ -21,7 +21,7 @@ public class Wait extends CommandBase {
/**
* Creates a new WaitCommand.
*/
public Wait(SubsystemBase subsystem, float seconds) {
public Wait(SubsystemBase subsystem, double seconds) {
// Use addRequirements() here to declare subsystem dependencies.
m_waitTime = (long) (seconds * 1000);