Upload New File

b43befa8 · 王鑫（21软） · 3dcb82e7 · b43befa8
Commit b43befa8 authored May 16, 2022 by 王鑫（21软）
Hide whitespace changes
Inline Side-by-side

Showing with 14 additions and 0 deletions

calculateCost.m calculateCost.m +14 -0

No files found.
--- a/calculateCost.m
+++ b/calculateCost.m
+%function:Calculate the error of the nearest spot check
+% - Params：
+%   - A: Initial sparse point cloud [n,3]
+%   - B: Target model point cloud [m,3]
+%   - Mdl: kdtree model of B
+% - Return：
+%   - cost:the error(Distance sum)
+function cost = calculateCost( A, B, Mdl)
+
+idx = knnsearch(Mdl,A);
+NN = B(idx,:);
+cost = sum(sqrt(sum((NN-A).^2,2)))/length(A);
+
+end