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