function?graph?=?bundleAdjustment（graph?adjustFocalLength）

%?convert?from?Rt?matrix?to?AngleAxis
nCam=length（graph.frames）;
Mot?=?zeros（32nCam）;
for?camera=1:nCam
????Mot（:1camera）?=?RotationMatrix2AngleAxis（graph.Mot（:1:3camera））;
????Mot（:2camera）?=?graph.Mot（:4camera）;
end



Str?=?graph.Str;
f??=?graph.f;


%?assume?px?py=0
px?=?0;
py?=?0;



residuals?=?reprojectionResidual（graph.ObsIdxgraph.ObsValpxpyfMotStr）;
fprintf（‘initial?error?=?%f\n‘?2*sqrt（sum（residuals.^2）/length（residuals）））;

%?bundle?adjustment?using?lsqnonlin?in?Matlab?（Levenberg-Marquardt）
options?=?optimoptions（@lsqnonlin‘Algorithm‘‘levenberg-marquardt‘‘Display‘‘off‘）;

%?adjust?structure?[for?homework]
%?!!!?fill?in?your?code?here
%fprintf（‘error?=?%f\n‘?2*sqrt（resnorm/length（residuals）））;

%?adjust?motion?[for?homework]
%?!!!?fill?in?your?code?here
%fprintf（‘error?=?%f\n‘?2*sqrt（resnorm/length（residuals）））;

%?adjust?motion?and?structure
[vecresnormresidualsexitflag]?=?lsqnonlin（@（x）?reprojectionResidual（graph.ObsIdxgraph.ObsValpxpyfx）?[Mot（:）;?Str（:）][][]options）;
[MotStr]?=?unpackMotStrf（nCamvec）;
fprintf（‘error?=?%f\n‘?2*sqrt（resnorm/length（residuals）））;


if?exist（‘adjustFocalLength‘‘var‘）?&&?adjustFocalLength
????%?adjust?focal?length?motion?and?structure
????[vecresnormresidualsexitflag]?=?lsqnonlin（@（x）?reprojectionResidual（graph.ObsIdxgraph.ObsValpxpyx）?[f;?Mot（:）;?Str（:）][][]options）;
????[MotStrf]?=?unpackMotStrf（nCamvec）;
????fprintf（‘error?=?%f\n‘?resnorm/length（residuals））;
????graph.f?=?f;
end


%residuals?=?reprojectionResidual（graph.ObsIdxgraph.ObsValpxpyfMotStr）;
%fprintf（‘final?error?=?%f\n‘?2*sqrt（sum（residuals.^2）/length（residuals）））;


for?camera=1:nCam
????graph.Mot（::camera）?=?[AngleAxis2RotationMatrix（Mot（:1camera））??Mot（:2camera）];????
end
graph.Str?=?Str;

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????目錄???????????0??2018-03-16?10:48??三維重建??matlab\
?????文件?????????222??2014-11-15?15:22??三維重建??matlab\._SFMedu2
?????文件???????24580??2014-11-15?15:22??三維重建??matlab\.DS_Store
?????文件????????1856??2014-09-03?18:08??三維重建??matlab\bundleAdjustment.m
?????目錄???????????0??2018-03-16?10:48??三維重建??matlab\denseMatch\
?????文件???????15364??2014-11-15?15:23??三維重建??matlab\denseMatch\.DS_Store
?????文件????????1899??2014-09-02?22:42??三維重建??matlab\denseMatch\denseMatch.m
?????目錄???????????0??2018-03-16?10:48??三維重建??matlab\denseMatch\priority_queue_1.0\
?????文件???????15364??2014-11-15?15:22??三維重建??matlab\denseMatch\priority_queue_1.0\.DS_Store
?????文件?????????104??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\CHANGES
?????文件????????1340??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\license.txt
?????文件???????13658??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\MyHeap.h
?????文件???????13341??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\MyHeap_old.h
?????文件????????1760??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.cpp
?????文件????????1270??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.m
?????文件???????10444??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.mexa64
?????文件???????14896??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.mexmaci
?????文件???????14736??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.mexmaci64
?????文件???????10752??2014-11-12?23:29??三維重建??matlab\denseMatch\priority_queue_1.0\pq_create.mexw64
?????文件????????1795??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.cpp
?????文件?????????570??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.m
?????文件????????8359??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.mexa64
?????文件????????9520??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.mexmaci
?????文件????????9408??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.mexmaci64
?????文件????????7680??2014-11-12?23:30??三維重建??matlab\denseMatch\priority_queue_1.0\pq_delete.mexw64
?????文件????????7872??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_demo.cpp
?????文件????????1014??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_demo.m
?????文件???????39971??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_demo.mexa64
?????文件????????2033??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_pop.cpp
?????文件?????????725??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_pop.m
?????文件???????15872??2012-08-25?15:06??三維重建??matlab\denseMatch\priority_queue_1.0\pq_pop.mexa64
............此處省略3931個文件信息