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?