@Override
public void periodic() {
odometryLock.lock(); // Prevents odometry updates while reading data
-
- java.util.List<BaseStatusSignal> signals = new java.util.ArrayList<>();
- var gyroYawSignal = gyroIO.getYawSignal();
- if (gyroYawSignal != null) {
- signals.add(gyroYawSignal);
- }
- for (var module : modules) {
- signals.add(module.getDrivePositionSignal());
- signals.add(module.getTurnPositionSignal());
- signals.add(module.getTurnAbsolutePositionSignal());
- }
- if (!signals.isEmpty()) {
- BaseStatusSignal.waitForAll(0.1, signals.toArray(new BaseStatusSignal[0]));
- }
-
gyroIO.updateInputs(gyroInputs);
Logger.processInputs("Drive/Gyro", gyroInputs);
for (var module : modules) {