Example Aim Code

package frc.robot;

import edu.wpi.first.wpilibj.networktables.NetworkTable;
import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.VictorSP;
import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj.SpeedControllerGroup;
import edu.wpi.first.wpilibj.drive.DifferentialDrive;
import edu.wpi.first.wpilibj.livewindow.LiveWindow;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;


public class Robot extends IterativeRobot {
	private VictorSP sagmotor1 = new VictorSP(0);
	private VictorSP sagmotor2 = new VictorSP(1);
	private VictorSP solmotor1 = new VictorSP(2);
	private VictorSP solmotor2 = new VictorSP(3);
	private Joystick stick = new Joystick(0);
	private Timer m_timer = new Timer();

  SpeedControllerGroup sagtekerler = new SpeedControllerGroup(sagmotor1, sagmotor2);
  SpeedControllerGroup soltekerler = new SpeedControllerGroup(solmotor1, solmotor2);
  private final DifferentialDrive robotDrive = new DifferentialDrive(soltekerler,sagtekerler);

	public static NetworkTable sycavision = NetworkTable.getTable("sycavision"); 


	@Override
	public void robotInit() {
	}

	@Override
	public void autonomousInit() {

	}
	
	public static double xloc()
	{
		return sycavision.getNumber("xloc", 0.0);
	}
	public static double yloc() 
	{
		return sycavision.getNumber("yloc", 0.0); 
	}


	@Override
	public void autonomousPeriodic() {

	}

	@Override
	public void teleopInit() {
	}


	@Override
	public void teleopPeriodic() {

    if(xloc() == 0){ // if xloc value = 0 stop robot
      sagmotor1.set(0); 
			sagmotor2.set(0);
      solmotor1.set(0); 
			solmotor2.set(0);
    }
		else if(xloc() < 130) // if xloc value Less than 130 turn right
		{
			sagmotor1.set(0.3); // power right motors
			sagmotor2.set(0.3);
		}
	  else if (xloc() > 190) // if xloc  greater than 190 turn left
		{
			solmotor1.set(0.3); //power left motors
			solmotor2.set(0.3);
    }
		SmartDashboard.putNumber("Xloc: ", xlocX());
		SmartDashboard.putNumber("yloc: ", yloc()); 

	}

	@Override
	public void testPeriodic() {
	}
}

}

Last updated

Was this helpful?