利用MATLAB計算三維座標序列距離誤差程序

利用MATLAB計算三維座標序列距離誤差程序

1.三維座標儲存在文件中，格式如下：

各座標間的距離真值是一定值，計算相鄰距離的標準差。

2.MATLAB程序如下：

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% 名稱：caculateAccuracy.m
% 功能：讀取三維世界座標，計算精度
% 作者：LYC
% 單位：中科院蘇州醫工所
% 日期：2014.5.5
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%% 清理各變量
clc, clear

%% 設定值
dataFile = 'v20131114-2.txt'; % 設定文件名稱
errorFile = 'v20131114-2_error.txt';

realValue = 1.00; % 設定真值

%% 讀取文件
fid = fopen(dataFile, 'r'); % 打開文件
k = 0; % 循環計數變量
curr = [0, 0, 0]; % 臨時變量
a = []; % 數據變量
while ~feof(fid) % 判斷是否到了文件末尾
    curr = fscanf(fid, '(%f, %f, %f)\n', 3);
    if ~isempty(curr)
       k = k+1;
       a = [a, curr];
    end
end
fclose(fid);

%% 計算各量之間的歐氏距離
dist = []; % 儲存歐氏距離
for i = 1:k-1
    curr2 = (a(1,i)-a(1,i+1))^2 + (a(2,i)-a(2,i+1))^2 + (a(3,i)-a(3,i+1))^2; % 計算當前距離的平方
    curr3 = sqrt(curr2); %計算當前距離
    dist = [dist, curr3];
end

%% 各距離減去距離真值
distError = dist - realValue; % 儲存距離誤差

%% 利用貝塞爾公式計算標準差
distError2 = distError.^2; % 計算誤差平方
sumError2 = sum(distError2);
std = sqrt(sumError2/(k-1))

%% 將結果寫入文件
fid2 = fopen(errorFile, 'w'); % 打開文件
fprintf(fid2, 'standard deviation = %f\r\n', std);
fprintf(fid2, 'distance errors are:\r\n');
for i = 1:k-1
    fprintf(fid2, '%f\r\n', distError(i)); %輸入當前數據與一空格
end
fclose(fid2);
disp('誤差寫入文件成功！');

3.誤差分析結果儲存在文件中，如下所示