Skip to content

Commit

Permalink
Add chassisAccelerations class
Browse files Browse the repository at this point in the history
  • Loading branch information
superpenguin612 committed Feb 26, 2024
1 parent 051557d commit 13df933
Showing 1 changed file with 22 additions and 0 deletions.
Original file line number Diff line number Diff line change
@@ -0,0 +1,22 @@
package com.techhounds.houndutil.houndlib;

import edu.wpi.first.math.kinematics.ChassisSpeeds;

public class ChassisAccelerations {
public double axMetersPerSecondSquared;
public double ayMetersPerSecondSquared;
public double omegaRadiansPerSecondSquared;

public ChassisAccelerations(double axMetersPerSecondSquared, double ayMetersPerSecondSquared,
double omegaRadiansPerSecondSquared) {
this.axMetersPerSecondSquared = axMetersPerSecondSquared;
this.ayMetersPerSecondSquared = ayMetersPerSecondSquared;
this.omegaRadiansPerSecondSquared = omegaRadiansPerSecondSquared;
}

public ChassisAccelerations(ChassisSpeeds speed, ChassisSpeeds previousSpeed, double dt) {
this.axMetersPerSecondSquared = (speed.vxMetersPerSecond - previousSpeed.vxMetersPerSecond) / dt;
this.ayMetersPerSecondSquared = (speed.vyMetersPerSecond - previousSpeed.vyMetersPerSecond) / dt;
this.omegaRadiansPerSecondSquared = (speed.omegaRadiansPerSecond - previousSpeed.omegaRadiansPerSecond) / dt;
}
}

0 comments on commit 13df933

Please sign in to comment.