基于离散三点计算曲率圆的方法

基于离散三点计算曲率圆的方法

%% 利用离散的三点求曲率
clc;
clear;

% 给出假设的三点
A = [[15,12]; [16,2]; [9,7]; [15,12]];

% 计算三条边的距离
distance1 = sqrt((A(1, 1) - A(2, 1))^2 + (A(1, 2) - A(2, 2))^2);
distance2 = sqrt((A(2, 1) - A(3, 1))^2 + (A(2, 2) - A(3, 2))^2);
distance3 = sqrt((A(3, 1) - A(4, 1))^2 + (A(3, 2) - A(4, 2))^2);

%依据余弦定理求cos(a)
cos_a = (distance2^2 + distance3^2 - distance1^2) / 2 * distance2 * distance3;

%依据正弦定理求出半径
sin_a = sqrt(1 - cos_a^2);
R = distance1 / (2 * sin_a);
curvature = 1 / R;

%% 画出这三点
figure(1)
hold on;
xlim([0 25]);
ylim([0 20]);
for i = 1 : 3
    plot(A(i, 1), A(i, 2), 'c*');
    plot([A(i,1), A(i+1, 1)], [A(i,2), A(i+1,2)]);
end