Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-22 01:11:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

[wpilib] ADIS16470: Add no-param GetAngle and GetRate (#6184)

Browse Source 
This helps with backwards compatibility.
This commit is contained in:
Isaac Turner
2024-01-13 03:00:42 +08:00
committed by GitHub
parent 2386e44f3a
commit d181e353a0
2 changed files with 60 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

54
wpilibj/src/main/java/edu/wpi/first/wpilibj/ADIS16470_IMU.java
View File

@@ -1136,6 +1136,33 @@ public class ADIS16470_IMU implements AutoCloseable, Sendable {
return 0.0;
}
/**
* Returns the Yaw axis angle in degrees (CCW positive).
*
* @return The Yaw axis angle in degrees (CCW positive).
*/
public synchronized double getAngle() {
switch (m_yaw_axis) {
case kX:
if (m_simGyroAngleX != null) {
return m_simGyroAngleX.get();
}
return m_integ_angle_x;
case kY:
if (m_simGyroAngleY != null) {
return m_simGyroAngleY.get();
}
return m_integ_angle_y;
case kZ:
if (m_simGyroAngleZ != null) {
return m_simGyroAngleZ.get();
}
return m_integ_angle_z;
default:
}
return 0.0;
}
/**
* Returns the axis angular rate in degrees per second (CCW positive).
*
@@ -1177,6 +1204,33 @@ public class ADIS16470_IMU implements AutoCloseable, Sendable {
return 0.0;
}
/**
* Returns the Yaw axis angular rate in degrees per second (CCW positive).
*
* @return Yaw axis angular rate in degrees per second (CCW positive).
*/
public synchronized double getRate() {
switch (m_yaw_axis) {
case kX:
if (m_simGyroRateX != null) {
return m_simGyroRateX.get();
}
return m_gyro_rate_x;
case kY:
if (m_simGyroRateY != null) {
return m_simGyroRateY.get();
}
return m_gyro_rate_y;
case kZ:
if (m_simGyroRateZ != null) {
return m_simGyroRateZ.get();
}
return m_gyro_rate_z;
default:
}
return 0.0;
}
/**
* Returns which axis, kX, kY, or kZ, is set to the yaw axis.
*