Skip to content

Instantly share code, notes, and snippets.

@TwoTau
Created February 1, 2017 04:22
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save TwoTau/9340b2ed196feb6402288b087186aaaa to your computer and use it in GitHub Desktop.
Save TwoTau/9340b2ed196feb6402288b087186aaaa to your computer and use it in GitHub Desktop.
hi
package org.usfirst.frc.team2976.robot.subsystems;
import org.usfirst.frc.team2976.robot.RobotMap;
import edu.wpi.first.wpilibj.AnalogGyro;
import edu.wpi.first.wpilibj.CANTalon;
import edu.wpi.first.wpilibj.Encoder;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.SpeedController;
import edu.wpi.first.wpilibj.command.Subsystem;
/**
*
*/
public class DriveTrain extends Subsystem {
private SpeedController rightFrontMotor, leftFrontMotor;
private SpeedController rightBackMotor, leftBackMotor;
private Encoder rightFrontDriveEncoder, leftFrontDriveEncoder, rightBackDriveEncoder, leftBackDriveEncoder;
public RobotDrive m_drive;
public DriveTrain() {
rightFrontMotor = new CANTalon(RobotMap.RightFrontDriveMotor);
leftFrontMotor = new CANTalon(RobotMap.LeftFrontDriveMotor);
rightBackMotor = new CANTalon(RobotMap.RightBackDriveMotor);
leftBackMotor = new CANTalon(RobotMap.LeftBackDriveMotor);
rightFrontDriveEncoder = new Encoder(RobotMap.RightFrontDriveEncoderA, RobotMap.RightFrontDriveEncoderB);
leftFrontDriveEncoder = new Encoder(RobotMap.LeftFrontDriveEncoderA, RobotMap.LeftFrontDriveEncoderB);
rightBackDriveEncoder = new Encoder(RobotMap.RightBackDriveEncoderA, RobotMap.RightBackDriveEncoderB);
leftBackDriveEncoder = new Encoder(RobotMap.LeftBackDriveEncoderA, RobotMap.LeftBackDriveEncoderB);
}
public void initDefaultCommand() {
// Set the default command for a subsystem here.
//setDefaultCommand(new MySpecialCommand());
}
public void drive(double y) {
rightFrontMotor.set(y);
leftFrontMotor.set(y);
rightBackMotor.set(y);
leftBackMotor.set(y);
}
private double getRightFrontDriveEncoderCount() {
return rightFrontDriveEncoder.get();
}
private double getLeftFrontDriveEncoderCount() {
return leftFrontDriveEncoder.get();
}
private double getRightBackDriveEncoderCount() {
return rightBackDriveEncoder.get();
}
private double getLeftBackDriveEncoderCount() {
return leftBackDriveEncoder.get();
}
//get velocity for the encoders
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment