lowered goal height correction

This commit is contained in:
Adam Long 2016-10-15 15:50:48 +00:00
parent a842fbb4ad
commit 77f44f8c36

View File

@ -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(){