limelighter coriger
This commit is contained in:
@@ -65,6 +65,9 @@ public class Limelighter extends Command {
|
|||||||
x = 11.915394;
|
x = 11.915394;
|
||||||
BotPose = limelight3g.getBotPoseRed();
|
BotPose = limelight3g.getBotPoseRed();
|
||||||
}
|
}
|
||||||
|
botx = BotPose[0];
|
||||||
|
boty = BotPose[1];
|
||||||
|
calcul = limelight3g.Calcule(botx, x, boty, 4, angle);
|
||||||
if(calcul > -5 && calcul < 5){
|
if(calcul > -5 && calcul < 5){
|
||||||
drivetrain.setControl(
|
drivetrain.setControl(
|
||||||
drive.withRotationalRate(0));
|
drive.withRotationalRate(0));
|
||||||
|
|||||||
Reference in New Issue
Block a user