@JvmStatic fun calculatePoseError(targetFieldPose: Pose2d, currentFieldPose: Pose2d): Pose2d
Returns the error between targetFieldPose and currentFieldPose.