/*
 * To change this license header, choose License Headers in Project Properties.
 * To change this template file, choose Tools | Templates
 * and open the template in the editor.
 */

package edu.wpi.first.wpilibj.templates;

/**
 *
 * @author Amy
 */

import edu.wpi.first.wpilibj.Gyro;
import edu.wpi.first.wpilibj.Encoder;
import edu.wpi.first.wpilibj.RobotDrive;


public class DriveTrain {
    RobotDrive drive;
    Gyro gyro;
    
    public DriveTrain(int frontLeftPort, int rearLeftPort, int frontRightPort, int rearRightPort, boolean[] inverted, int gyroPort) {
        drive = new RobotDrive(frontLeftPort, rearLeftPort, frontRightPort, rearRightPort);
        drive.setInvertedMotor(RobotDrive.MotorType.kFrontLeft, inverted[0]);
        drive.setInvertedMotor(RobotDrive.MotorType.kRearLeft, inverted[1]);
        drive.setInvertedMotor(RobotDrive.MotorType.kFrontRight, inverted[2]);
        drive.setInvertedMotor(RobotDrive.MotorType.kRearRight, inverted[3]);
        drive.setSafetyEnabled(true);
        gyro = new Gyro(gyroPort);
    }
    
    public void drive(double x, double y, double rotation) {
        drive.mecanumDrive_Cartesian(x, y, rotation, gyro.getAngle());
    }
   
    public void frontRight() {
     
        
        
    }
    
    public void frontLeft() {
        
        
        
    }   
    
    public void backRight() {
        
        
        
    }
    
    public void backLeft() {
        
        
        
    }
   
    public void moveForward(int speed) {
        
    } 
}

@@ -362,16 +362,52 @@
 tDrive;%0A
+import edu.wpi.first.wpilibj.Talon;%0A
 %0A%0Apublic
@@ -463,24 +463,361 @@
 o gyro;%0A    
+public static final int FRPORT = 1;%0A    public static final int FLPORT = 1;%0A    public static final int BRPORT = 1;%0A    public static final int BLPORT = 1;%0A    %0A    Talon frontRight = new Talon(FRPORT);%0A    Talon frontLeft = new Talon(FLPORT);%0A    Talon backRight = new Talon(BRPORT);%0A    Talon backLeft = new Talon(BLPORT);%0A    %0A       
 %0A    public 
@@ -1589,28 +1589,37 @@
 oid 
-frontRight(
+moveForward(double speed
 ) %7B%0A 
-    
 %0A   
@@ -1627,80 +1627,120 @@
     
-%0A        %0A    %7D
+frontRight.set(speed);
 %0A    
-%0A
     
-public void frontLeft() %7B%0A        %0A        %0A   
+frontLeft.set(speed);%0A        backRight.set(speed);%0A        backLeft.set(speed);%0A
     
@@ -1747,18 +1747,16 @@
  %0A    %7D 
-  
 %0A    %0A  
@@ -1773,20 +1773,63 @@
 oid 
-backRight() 
+driveCustom(double fr, double fl, double br, double bl)
 %7B%0A  
@@ -1826,32 +1826,33 @@
 le bl)%7B%0A        
+ 
 %0A        %0A      
@@ -1848,150 +1848,167 @@
     
-%0A        
+frontRight.set(fr);%0A        frontLeft.set(fl);
 %0A    
-%7D%0A
     
-%0A    public void backLeft() %7B%0A        %0A        %0A        %0A    %7D%0A   %0A    public void moveForward(int speed) %7B
+backRight.set(br);%0A        backLeft.set(bl);%0A               %0A        %0A        %0A        
 %0A    
+%7D
     
-%0A
+  
     
-%7D
  %0A%7D%0A
+%0A

Put in drive methods (?)