test de formule pour b pas concluant(j'ai moins peur)
This commit is contained in:
@@ -51,10 +51,10 @@ public class AprilTag3 extends Command {
|
|||||||
double b = (limelight3.getTA()*100) / (Math.cos(90-limelight3.getTx()));
|
double b = (limelight3.getTA()*100) / (Math.cos(90-limelight3.getTx()));
|
||||||
if(limelight3.getV() == true){
|
if(limelight3.getV() == true){
|
||||||
drivetrain.setControl(drive.
|
drivetrain.setControl(drive.
|
||||||
withRotationalRate(a/10).
|
withRotationalRate(a/20).
|
||||||
withVelocityX(0).
|
withVelocityX(0).
|
||||||
withVelocityY( b/30));
|
withVelocityY( b/50));
|
||||||
System.out.println(b/10);
|
System.out.println(b/50);
|
||||||
}
|
}
|
||||||
else{
|
else{
|
||||||
drivetrain.setControl(drive.
|
drivetrain.setControl(drive.
|
||||||
|
|||||||
@@ -8,7 +8,6 @@ import edu.wpi.first.wpilibj.DigitalInput;
|
|||||||
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
|
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
|
||||||
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
|
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
|
||||||
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
||||||
import edu.wpi.first.wpilibj2.command.sysid.SysIdRoutine;
|
|
||||||
|
|
||||||
import com.revrobotics.spark.SparkMax;
|
import com.revrobotics.spark.SparkMax;
|
||||||
import com.revrobotics.spark.SparkLowLevel.MotorType;
|
import com.revrobotics.spark.SparkLowLevel.MotorType;
|
||||||
|
|||||||
Reference in New Issue
Block a user