This commit is contained in:
@@ -67,16 +67,10 @@ public class AprilTag3 extends Command {
|
|||||||
if(tagId ==8){
|
if(tagId ==8){
|
||||||
drivetrain.setControl(drive.
|
drivetrain.setControl(drive.
|
||||||
withRotationalRate(tx/20).
|
withRotationalRate(tx/20).
|
||||||
withVelocityX(MathUtil.clamp(-x/4, -1, 1)).
|
withVelocityX(2-botx).
|
||||||
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
|
withVelocityY(2-botz));
|
||||||
}
|
}
|
||||||
else if(Botyaw >-180 && Botyaw <=-90){
|
}
|
||||||
drivetrain.setControl(drive.
|
|
||||||
withRotationalRate(tx/20).
|
|
||||||
withVelocityX(MathUtil.clamp(x/4, -1, 1)).
|
|
||||||
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else{
|
else{
|
||||||
drivetrain.setControl(drive.
|
drivetrain.setControl(drive.
|
||||||
withRotationalRate(0).
|
withRotationalRate(0).
|
||||||
|
|||||||
Reference in New Issue
Block a user