grimpe en auto
This commit is contained in:
@@ -88,7 +88,7 @@ public class GrimperMur extends Command {
|
||||
else{
|
||||
pigeonAngle = drivetrain.getPigeon2().getYaw().getValueAsDouble()+180;
|
||||
System.out.println(pigeonAngle);
|
||||
y = 5.4;
|
||||
y = 5.2;
|
||||
x = 1.11;
|
||||
angle = 0;
|
||||
if(pigeonAngle> 358 || pigeonAngle< 2){
|
||||
|
||||
@@ -69,7 +69,7 @@ public class GrimperReservoir extends Command {
|
||||
if(alliance.get() == Alliance.Red){
|
||||
pigeonAngle = drivetrain.getPigeon2().getYaw().getValueAsDouble();
|
||||
System.out.println(pigeonAngle);
|
||||
y = 5.4;
|
||||
y = 5.2;
|
||||
x = 15.6;
|
||||
angle = 180;
|
||||
if(pigeonAngle< 190 && pigeonAngle> 170){
|
||||
|
||||
Reference in New Issue
Block a user