}
/**
- * @return Posiiton of the turret in radians
+ * @return Posiiton of the turret in degrees
*/
public double getPositionDeg() {
return Units.rotationsToDegrees(motor.getPosition().getValueAsDouble()) / GEAR_RATIO;
import edu.wpi.first.math.util.Units;
public class TurretConstants {
- public static double MAX_ANGLE = 200;
- public static double MIN_ANGLE = -200;
+ public static double MAX_ANGLE = 200; // Deg
+ public static double MIN_ANGLE = -200; // Deg
public static double MAX_VELOCITY = 600; // rad/s
public static double MAX_ACCELERATION = 120.0; // rad/s^2