// RobotBuilder Version: 1.5
//
// This file was generated by RobotBuilder. It contains sections of
// code that are automatically generated and assigned by robotbuilder.
// These sections will be updated in the future when you export to
// Java from RobotBuilder. Do not put any code or make any change in
// the blocks indicating autogenerated code or it will be lost on an
// update. Deleting the comments indicating the section will prevent
// it from being updated in the future.


package org.usfirst.frc322.FRCTeam0322JavaCBR2015.subsystems;

import org.usfirst.frc322.FRCTeam0322JavaCBR2015.RobotMap;
import org.usfirst.frc322.FRCTeam0322JavaCBR2015.commands.*;
import edu.wpi.first.wpilibj.*;

import edu.wpi.first.wpilibj.command.Subsystem;
import org.usfirst.frc322.FRCTeam0322JavaCBR2015.subsystems.ChassisSensors;


/**
 *
 */
public class Chassis extends Subsystem {
    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
    SpeedController frontLeftMotor = RobotMap.chassisFrontLeftMotor;
    SpeedController rearLeftMotor = RobotMap.chassisRearLeftMotor;
    SpeedController frontRightMotor = RobotMap.chassisFrontRightMotor;
    SpeedController rearRightMotor = RobotMap.chassisRearRightMotor;
    RobotDrive robotDrive41 = RobotMap.chassisRobotDrive41;

    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS

    
    // Put methods for controlling this subsystem
    // here. Call these from Commands.

    public void initDefaultCommand() {
        // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DEFAULT_COMMAND
        setDefaultCommand(new DriveWithJoystick());

    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DEFAULT_COMMAND
	
        // Set the default command for a subsystem here.
        //setDefaultCommand(new MySpecialCommand());
    }
    
    public void driveWithJoystick(Joystick driveStick){
    	//robotDrive41.arcadeDrive(driveStick);
    	robotDrive41.mecanumDrive_Cartesian(driveStick.getX(), driveStick.getY(), driveStick.getZ(),
    											RobotMap.chassisSensorsGyro1.getAngle());
    }
}


@@ -1864,53 +1864,8 @@
 k)%7B%0A
-    %09//robotDrive41.arcadeDrive(driveStick);%0A
     
@@ -1919,10 +1919,17 @@
 .get
-X(
+RawAxis(0
 ), d
@@ -1945,13 +1945,20 @@
 .get
-Y(), 
+RawAxis(1),%09
 driv
@@ -1971,10 +1971,17 @@
 .get
-Z(
+RawAxis(2
 ),%0A 
@@ -1993,17 +1993,16 @@
 %09%09%09%09%09%09%09%09
-%09
 RobotMap

Change mecanumDrive to Raw Inputs