How to use
get
method
in
us.ihmc.robotics.math.filters.AlphaFilteredYoFrameVector

Best Java code snippets using us.ihmc.robotics.math.filters.AlphaFilteredYoFrameVector.get (Showing top 3 results out of 315)

@Override
public void getLinearAccelerationBiasInIMUFrame(IMUSensorReadOnly imu, Vector3d linearAccelerationBiasToPack)
{
 Integer imuIndex = imuToIndexMap.get(imu);
 if (!enableIMUBiasCompensation.getBooleanValue() || imuIndex == null)
   linearAccelerationBiasToPack.set(0.0, 0.0, 0.0);
 else
   linearAccelerationBiases.get(imuIndex.intValue()).get(linearAccelerationBiasToPack);
}

@Override
public void getAngularVelocityBiasInIMUFrame(IMUSensorReadOnly imu, Vector3d angularVelocityBiasToPack)
{
 Integer imuIndex = imuToIndexMap.get(imu);
 if (!enableIMUBiasCompensation.getBooleanValue() || imuIndex == null)
   angularVelocityBiasToPack.set(0.0, 0.0, 0.0);
 else
   angularVelocityBiases.get(imuIndex.intValue()).get(angularVelocityBiasToPack);
}

angularVelocityBiases.get(imuIndex).get(measurementBias);
orientationMeasurement.transform(measurementBias);
angularVelocityBiasesInWorld.get(imuIndex).set(measurementBias);
linearAccelerationBiases.get(imuIndex).get(measurementBias);
orientationMeasurement.transform(measurementBias);
linearAccelerationBiasesInWorld.get(imuIndex).set(measurementBias);