calculateFieldPoseError

fun calculateFieldPoseError(targetFieldPose: Pose2d, currentFieldPose: Pose2d): Pose2d

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