mirror of
https://github.com/BroncBotz3481/YAGSL
synced 2026-06-19 06:21:40 +00:00
Updated to 2024.4.6.1
This commit is contained in:
@@ -19,7 +19,11 @@ public class AnalogGyroSwerve extends SwerveIMU
|
||||
/**
|
||||
* Offset for the analog gyro.
|
||||
*/
|
||||
private Rotation3d offset = new Rotation3d();
|
||||
private Rotation3d offset = new Rotation3d();
|
||||
/**
|
||||
* Inversion for the gyro
|
||||
*/
|
||||
private boolean invertedIMU = false;
|
||||
|
||||
/**
|
||||
* Analog port in which the gyroscope is connected. Can only be attached to analog ports 0 or 1.
|
||||
@@ -67,6 +71,16 @@ public class AnalogGyroSwerve extends SwerveIMU
|
||||
this.offset = offset;
|
||||
}
|
||||
|
||||
/**
|
||||
* Set the gyro to invert its default direction
|
||||
*
|
||||
* @param invertIMU invert gyro direction
|
||||
*/
|
||||
public void setInverted(boolean invertIMU)
|
||||
{
|
||||
invertedIMU = invertIMU;
|
||||
}
|
||||
|
||||
/**
|
||||
* Fetch the {@link Rotation3d} from the IMU without any zeroing. Robot relative.
|
||||
*
|
||||
@@ -74,7 +88,8 @@ public class AnalogGyroSwerve extends SwerveIMU
|
||||
*/
|
||||
public Rotation3d getRawRotation3d()
|
||||
{
|
||||
return new Rotation3d(0, 0, Math.toRadians(-gyro.getAngle()));
|
||||
Rotation3d reading = new Rotation3d(0, 0, Math.toRadians(-gyro.getAngle()));
|
||||
return invertedIMU ? reading.unaryMinus() : reading;
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user