search

ihmcrobotics / euclid

Vector math, geometry, reference frame, and shapes 2D & 3D
Apache License 2.0
31 stars 9 forks source link

`RigidBodyTransformReadOnly#epsilonEquals` should accept separate epsilons for rotation and translation #65

Open calvertdw opened 5 months ago

calvertdw commented 5 months ago

I made this in EuclidCoreMissingTools for now.

public static boolean epsilonEquals(RigidBodyTransformReadOnly a, RigidBodyTransformReadOnly b, double rotationEpsilon, double translationEpsilon)
{
   return a.getRotation().geometricallyEquals(b.getRotation(), rotationEpsilon)
       && a.getTranslation().geometricallyEquals(b.getTranslation(), translationEpsilon);
}