matlab空间三点求圆心

function p = CircleCenter(p1, p2, p3)
% CircleCenter(p1, p2, p3) 根据三个空间点，计算出其圆心
%   p1,p2,p3:三个空间点
% 圆的法向量
pf= cross(p1-p2, p1-p3);

if any(pf == 0)
error('三个点不能共线！！');
end

% 两条线段的重点，之后需要求中垂线
p12 = (p1 + p2)/2;
p23 = (p2 + p3)/2;

% 求两条线的中垂线
p12f = cross(pf, p1-p2);
p23f = cross(pf, p2-p3);

% 求在中垂线上投影的大小
ds = ( (p12(2)-p23(2))*p12f(1) - (p12(1)-p23(1))*p12f(2) ) / ( p23f(2)*p12f(1) - p12f(2)*p23f(1) );

% 得出距离
p = p23 + p23f .* ds;

end