diff options
| author | leochanj105 <leochanj@live.unc.edu> | 2020-10-19 23:09:30 -0400 |
|---|---|---|
| committer | leochanj105 <leochanj@live.unc.edu> | 2020-10-20 02:40:39 -0400 |
| commit | f618466c25d43f3bae9e40920273bf77de1e1149 (patch) | |
| tree | 460e739e2165b8a9c37a9c7ab1b60f5874903543 /SD-VBS/common/toolbox/ikkjin/getANMS.m | |
| parent | 47ced4e96bbb782b9e780e8f2cfc637b2c21ff44 (diff) | |
initial sd-vbs
initial sd-vbs
add sd-vbs
sd-vbs
Diffstat (limited to 'SD-VBS/common/toolbox/ikkjin/getANMS.m')
| -rwxr-xr-x | SD-VBS/common/toolbox/ikkjin/getANMS.m | 30 |
1 files changed, 30 insertions, 0 deletions
diff --git a/SD-VBS/common/toolbox/ikkjin/getANMS.m b/SD-VBS/common/toolbox/ikkjin/getANMS.m new file mode 100755 index 0000000..a40d50c --- /dev/null +++ b/SD-VBS/common/toolbox/ikkjin/getANMS.m | |||
| @@ -0,0 +1,30 @@ | |||
| 1 | function [interestPnts]=getANMS(x, y, v, r, dataDir) | ||
| 2 | MAX_LIMIT=100000; | ||
| 3 | C_ROBUST=1; | ||
| 4 | r_sq=r^2; | ||
| 5 | points=[x y v]; | ||
| 6 | [n temp]=size(v); | ||
| 7 | [srtdV srtdVIdx]=sort(v,'descend'); | ||
| 8 | srtdPnts=points(srtdVIdx,:); | ||
| 9 | |||
| 10 | interestPnts=zeros(0,3); | ||
| 11 | |||
| 12 | suppressR=ones(n,1)*MAX_LIMIT; | ||
| 13 | supId=find(suppressR>r_sq); | ||
| 14 | |||
| 15 | iter = 0; | ||
| 16 | while length(supId)>0 | ||
| 17 | |||
| 18 | interestPnts=[interestPnts; srtdPnts(supId(1),:)]; | ||
| 19 | srtdPnts=srtdPnts(supId(2:end),:); | ||
| 20 | suppressR=suppressR(supId(2:end),:); | ||
| 21 | |||
| 22 | suppressR=min(suppressR,... | ||
| 23 | (C_ROBUST*interestPnts(end,3)>=srtdPnts(:,3)).*... | ||
| 24 | ((srtdPnts(:,1)-interestPnts(end,1)).^2 + (srtdPnts(:,2)-interestPnts(end,2)).^2)... | ||
| 25 | +(C_ROBUST*interestPnts(end,3)<srtdPnts(:,3))*... | ||
| 26 | MAX_LIMIT); | ||
| 27 | |||
| 28 | iter = iter + 1; | ||
| 29 | supId=find(suppressR>r_sq); | ||
| 30 | end | ||
