@JvmStatic fun calculateFieldPoseError(targetFieldPose: Pose2d, currentFieldPose: Pose2d): Pose2d
Returns the error between targetFieldPose and currentFieldPose in the field frame.