gtsam/matlab/frank05_rightPreconditioning.m

34 lines
504 B
Matlab

% frank05: show right pre-conditioning
% first run frank03 or other script to generate graph, config, and ordering
% linearize the non-linear factor graph
tic
LFG = graph.linearize_(config);
toc
tic
ijs = LFG.sparse(ordering);
A = sparse(ijs(1,:),ijs(2,:),ijs(3,:));
toc
figure(1)
spy(A);
% isolate the spanning tree part
A1=A(1:3*nnz(tree),:);
figure(2)
spy(A1)
% calculate
tic
R1 = qr(A1,0);
toc
figure(3)
spy(R1)
% calculate the entire R factor (expensive)
tic
R = qr(A,0);
toc
figure(4)
spy(R)