calculateFieldPoseError

public final static Pose2d calculateFieldPoseError(Pose2d targetFieldPose, Pose2d currentFieldPose)

Returns the error between targetFieldPose and currentFieldPose in the field frame.