Rev | Line | |
---|
[37] | 1 | % mfFDs first order geometric error (Sampson distance) |
---|
| 2 | % m-version of the original c-code (mex) which were |
---|
| 3 | % causing some problems |
---|
| 4 | |
---|
| 5 | % $Author: svoboda $ |
---|
| 6 | % $Revision: 2.2 $ |
---|
| 7 | % $Id: mfFDs.m,v 2.2 2004/05/04 16:09:35 svoboda Exp $ |
---|
| 8 | % $State: Exp $ |
---|
| 9 | |
---|
| 10 | function err = mfFDs(F,u); |
---|
| 11 | |
---|
| 12 | % disp('m-version of fFDs') |
---|
| 13 | |
---|
| 14 | Fu1 = F*u(4:6,:); |
---|
| 15 | Fu2 = (F'*u(1:3,:)).^2; |
---|
| 16 | Fu1pow = Fu1.^2; |
---|
| 17 | |
---|
| 18 | denom = Fu1pow(1,:)+Fu1pow(2,:)+Fu2(1,:)+Fu2(2,:); |
---|
| 19 | |
---|
| 20 | errvec = zeros(1,size(u,2)); |
---|
| 21 | for i=1:size(u,2), |
---|
| 22 | xFx = u(1:3,i)'*Fu1(:,i); |
---|
| 23 | errvec(i) = xFx^2/denom(i); |
---|
| 24 | end |
---|
| 25 | |
---|
| 26 | err = errvec; |
---|
| 27 | return |
---|
| 28 | |
---|
Note: See
TracBrowser
for help on using the repository browser.