lowered goal height correction
This commit is contained in:
parent
a842fbb4ad
commit
77f44f8c36
@ -90,7 +90,7 @@ public class MainArm extends PIDSubsystem {
|
||||
return false;
|
||||
}
|
||||
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));
|
||||
}
|
||||
public double getSonarDistanceRaw(){
|
||||
|
Loading…
x
Reference in New Issue
Block a user