public final static double OFFSET = -135.0; // in degrees
public final static double[] armPotValue = { 0.0, 45.0, 90.0 }; // 3
- // level
- public final static double ARM_LENGTH = 0; // TODO: find actual length
- public final static double HAND_LENGTH = 0; // TODO: find actual length
- public final static double ARM_MOUNTED_HEIGHT = 0; // TODO: find actual
// height
}
// Passing Defenses Constants
- public static final double DEFAULT_SPEED = 0.5;
public static final boolean IS_USING_TIME = true;
// dead reckoning time and speed constants for driving through defenses
defenseHand.set(speed);
}
- // TODO: figure out if measurements are all in inches
- public double getArmHorizontalDisplacement() {
- double armHorizontalDisplacement = Constants.DefenseArm.ARM_LENGTH
- * Math.cos(getArmPotAngle());
- double handHorizontalDisplacement = Constants.DefenseArm.HAND_LENGTH
- * Math.cos(getHandPotAngle());
- return (armHorizontalDisplacement + handHorizontalDisplacement);
- }
-
- public double getArmVerticalDisplacement() {
- double armMounted = Constants.DefenseArm.ARM_MOUNTED_HEIGHT;
- double armVerticalDisplacement = Constants.DefenseArm.ARM_LENGTH
- * Math.sin(getArmPotAngle());
- double handVerticalDisplacement = Constants.DefenseArm.HAND_LENGTH
- * Math.sin(getHandPotAngle());
- return (armMounted + armVerticalDisplacement + handVerticalDisplacement);
- }
-
- public double getArmHorizontalDist() {
- double arm = Constants.DefenseArm.ARM_LENGTH * Math.cos(getArmPotAngle());
- double hand = Constants.DefenseArm.HAND_LENGTH
- * Math.cos(getHandPotAngle());
- return (arm + hand);
- }
-
- public double getArmHeight() {
- double armMounted = Constants.DefenseArm.ARM_MOUNTED_HEIGHT;
- double arm = Constants.DefenseArm.ARM_LENGTH * Math.sin(getArmPotAngle());
- double hand = Constants.DefenseArm.HAND_LENGTH
- * Math.sin(getHandPotAngle());
- return (armMounted + arm + hand);
- }
-
- public boolean isOutsideRange() {
- if (getArmHorizontalDist() < 15)
- return false;
- return true;
- }
-
@Override
protected void initDefaultCommand() {
}