Yp = R-√(R^2 - Xp^2)