Thread: Twitchy Motors
View Single Post
  #20   Spotlight this post!  
Unread 12-02-2016, 18:58
hwu24110 hwu24110 is offline
Registered User
FRC #0988
 
Join Date: Feb 2014
Location: Las Vegas
Posts: 44
hwu24110 is an unknown quantity at this point
Re: Twitchy Motors

We do prop it on blocks when we test it.

I swapped the PWM ports to 4, 5, 6, and 7 and it still twitches.

Code:
package org.usfirst.frc.team988.robot;


import edu.wpi.first.wpilibj.SampleRobot;
import edu.wpi.first.wpilibj.Talon;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj.Victor;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;

public class Robot extends SampleRobot {
    Joystick stickL;
    Joystick stickR;
    final String defaultAuto = "Default";
    final String customAuto = "My Auto";
    SendableChooser chooser;
    Talon LF;
    Talon RF;
    Talon LR;
    Talon RR;

    public Robot() {
        stickL = new Joystick(0);
        stickR = new Joystick(1);
        LF = new Talon(4);
        RF = new Talon(5);
        LR = new Talon(6);
        RR = new Talon(7);
        
    }
    
    public void robotInit() {
        chooser = new SendableChooser();
        chooser.addDefault("Default Auto", defaultAuto);
        chooser.addObject("My Auto", customAuto);
        SmartDashboard.putData("Auto modes", chooser);
    }

    public void autonomous() {
    	
    	String autoSelected = (String) chooser.getSelected();
//		String autoSelected = SmartDashboard.getString("Auto Selector", defaultAuto);
		System.out.println("Auto selected: " + autoSelected);
    	
    	switch(autoSelected) {
    	case customAuto:
            break;
    	case defaultAuto:
    	default:
            break;
    	}
    }

    public void operatorControl() {
        LF.setSafetyEnabled(true);
        LR.setSafetyEnabled(true);
        RF.setSafetyEnabled(true);
        RR.setSafetyEnabled(true);
        while (isOperatorControl() && isEnabled()) {
            LF.set(-stickL.getRawAxis(1)); 
            LR.set(-stickL.getRawAxis(1));
            RF.set(stickR.getRawAxis(1));
            RR.set(stickR.getRawAxis(1));
            Timer.delay(0.005);		// wait for a motor update time
        }
    }

    /**
     * Runs during test mode
     */
    public void test() {
    }
}