in the initialize() method, we set isHighGear to false. In the following if/else, we then set:
autoTurnRampZone = RobotMap.AUTO_TURN_RAMP_ZONE_LOW;
autoTurnMaxSpeed = RobotMap.AUTO_TURN_MAX_SPEED_LOW;
autoTurnMinSpeed = RobotMap.AUTO_TURN_MIN_SPEED_LOW;
We either need to query the DriveTrain to find out whether we are actually in HighGear or else we need to call DriveTrain.shift(Down) to make sure that we are in low gear.
in the initialize() method, we set isHighGear to false. In the following if/else, we then set: autoTurnRampZone = RobotMap.AUTO_TURN_RAMP_ZONE_LOW; autoTurnMaxSpeed = RobotMap.AUTO_TURN_MAX_SPEED_LOW; autoTurnMinSpeed = RobotMap.AUTO_TURN_MIN_SPEED_LOW;
We either need to query the DriveTrain to find out whether we are actually in HighGear or else we need to call DriveTrain.shift(Down) to make sure that we are in low gear.