package org.usfirst.frc4909.STEAMWORKS.commands;

import edu.wpi.first.wpilibj.command.Command;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;

import org.usfirst.frc4909.STEAMWORKS.Robot;

public class DriveCommand extends Command {
    public DriveCommand() {
        requires(Robot.drivetrain);
    }

    protected void initialize() {}

    protected void execute() {
    	Robot.drivetrain.moveTank();
    	/*
		SmartDashboard.putNumber("X dist",Robot.drivetrain.getDisplacementX());
		SmartDashboard.putNumber("Y dist",Robot.drivetrain.getDisplacementY());
		SmartDashboard.putNumber("Z dist",Robot.drivetrain.getDisplacementZ());
		*/
    	
		SmartDashboard.putNumber("Left dist",Robot.drivetrain.getLeftEncDistance());
		SmartDashboard.putNumber("Right dist",Robot.drivetrain.getRightEncDistance());
    }

    protected boolean isFinished() {
        return false;
    }

    protected void end() {
    	Robot.drivetrain.stop();
    }
    
    protected void interrupted() {
    	end();
    }
}
@@ -416,409 +416,8 @@
 ();%0A
-    %09/*%0A%09%09SmartDashboard.putNumber(%22X dist%22,Robot.drivetrain.getDisplacementX());%0A%09%09SmartDashboard.putNumber(%22Y dist%22,Robot.drivetrain.getDisplacementY());%0A%09%09SmartDashboard.putNumber(%22Z dist%22,Robot.drivetrain.getDisplacementZ());%0A%09%09*/%0A    %09%0A%09%09SmartDashboard.putNumber(%22Left dist%22,Robot.drivetrain.getLeftEncDistance());%0A%09%09SmartDashboard.putNumber(%22Right dist%22,Robot.drivetrain.getRightEncDistance());%0A
     

Remove SmartDashboard Data for Teleop. Drive