lowered goal height correction
This commit is contained in:
parent
a842fbb4ad
commit
77f44f8c36
@ -90,7 +90,7 @@ public class MainArm extends PIDSubsystem {
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
public double getShooterAngleError(){
|
public double getShooterAngleError(){
|
||||||
double correctedHeight = (RobotMap.goalHeight + 24) - 44; //44 is the distance between the ground and the sonar
|
double correctedHeight = (RobotMap.goalHeight + 16) - 44; //44 is the distance between the ground and the sonar
|
||||||
return (180/Math.PI) * Math.atan(correctedHeight/(getSonarDistance()-1));
|
return (180/Math.PI) * Math.atan(correctedHeight/(getSonarDistance()-1));
|
||||||
}
|
}
|
||||||
public double getSonarDistanceRaw(){
|
public double getSonarDistanceRaw(){
|
||||||
|
Loading…
x
Reference in New Issue
Block a user