From: EvanYap Date: Sat, 30 Jan 2016 22:17:06 +0000 (-0800) Subject: Instantiate and run gyro method in TeleOp X-Git-Url: http://challenge-bot.com/repos/?a=commitdiff_plain;h=81f3b7dbb6b5d3e947cd3c1bbefe8b8108cd9f96;p=3501%2Fstronghold-2016 Instantiate and run gyro method in TeleOp --- diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java index bc3d735e..45505462 100644 --- a/src/org/usfirst/frc/team3501/robot/Robot.java +++ b/src/org/usfirst/frc/team3501/robot/Robot.java @@ -138,6 +138,5 @@ public class Robot extends IterativeRobot { @Override public void teleopPeriodic() { Scheduler.getInstance().run(); - } } diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java index 6c004b42..7c27d12e 100644 --- a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java +++ b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java @@ -1,8 +1,10 @@ package org.usfirst.frc.team3501.robot.subsystems; import org.usfirst.frc.team3501.robot.Constants; +import org.usfirst.frc.team3501.robot.FirebotGyro; import org.usfirst.frc.team3501.robot.Lidar; +import edu.wpi.first.wpilibj.AnalogInput; import edu.wpi.first.wpilibj.CANTalon; import edu.wpi.first.wpilibj.CounterBase.EncodingType; import edu.wpi.first.wpilibj.Encoder; @@ -31,6 +33,9 @@ public class DriveTrain extends Subsystem { Kd = 0.0 * (OUTPUT_SPROCKET_DIAMETER / PULSES_PER_ROTATION) / (WHEEL_SPROCKET_DIAMETER) * WHEEL_DIAMETER; + public AnalogInput channel; + public FirebotGyro gyro; + public DriveTrain() { frontLeft = new CANTalon(Constants.DriveTrain.FRONT_LEFT); frontRight = new CANTalon(Constants.DriveTrain.FRONT_RIGHT); @@ -47,6 +52,8 @@ public class DriveTrain extends Subsystem { leftEncoder.setDistancePerPulse(INCHES_PER_PULSE); rightEncoder.setDistancePerPulse(INCHES_PER_PULSE); + gyro = new FirebotGyro(I2C.Port.kOnboard, (byte) 0x68); + } @Override @@ -98,4 +105,5 @@ public class DriveTrain extends Subsystem { this.rearLeft.set(leftSpeed); this.rearRight.set(-rightSpeed); } + }