Renamed some examples
parent
83dc580220
commit
f1c5b9f5dc
|
@ -44,7 +44,7 @@ result = graph.optimize(initialEstimate);
|
||||||
result.print(sprintf('\nFinal result:\n '));
|
result.print(sprintf('\nFinal result:\n '));
|
||||||
|
|
||||||
%% Plot Covariance Ellipses
|
%% Plot Covariance Ellipses
|
||||||
figure(1);clf;
|
cla;
|
||||||
plot(result.xs(),result.ys(),'k*-'); hold on
|
plot(result.xs(),result.ys(),'k*-'); hold on
|
||||||
marginals = graph.marginals(result);
|
marginals = graph.marginals(result);
|
||||||
for i=1:result.size()
|
for i=1:result.size()
|
|
@ -62,7 +62,7 @@ result = graph.optimize(initialEstimate);
|
||||||
result.print(sprintf('\nFinal result:\n'));
|
result.print(sprintf('\nFinal result:\n'));
|
||||||
|
|
||||||
%% Plot Covariance Ellipses
|
%% Plot Covariance Ellipses
|
||||||
figure(1);clf;hold on
|
cla;hold on
|
||||||
marginals = graph.marginals(result);
|
marginals = graph.marginals(result);
|
||||||
for i=1:3
|
for i=1:3
|
||||||
key = symbol('x',i);
|
key = symbol('x',i);
|
||||||
|
|
|
@ -56,7 +56,7 @@ result = graph.optimize(initialEstimate);
|
||||||
result.print(sprintf('\nFinal result:\n'));
|
result.print(sprintf('\nFinal result:\n'));
|
||||||
|
|
||||||
%% Plot Covariance Ellipses
|
%% Plot Covariance Ellipses
|
||||||
figure(1);clf;
|
cla;
|
||||||
plot(result.xs(),result.ys(),'k*-'); hold on
|
plot(result.xs(),result.ys(),'k*-'); hold on
|
||||||
plot([result.pose(5).x;result.pose(2).x],[result.pose(5).y;result.pose(2).y],'r-');
|
plot([result.pose(5).x;result.pose(2).x],[result.pose(5).y;result.pose(2).y],'r-');
|
||||||
marginals = graph.marginals(result);
|
marginals = graph.marginals(result);
|
||||||
|
|
|
@ -38,7 +38,7 @@ initial.insertPose(4, hexagon.pose(4).retract(s*randn(6,1)));
|
||||||
initial.insertPose(5, hexagon.pose(5).retract(s*randn(6,1)));
|
initial.insertPose(5, hexagon.pose(5).retract(s*randn(6,1)));
|
||||||
|
|
||||||
%% Plot Initial Estimate
|
%% Plot Initial Estimate
|
||||||
figure(1);clf
|
cla
|
||||||
plot3(initial.xs(),initial.ys(),initial.zs(),'g-*');
|
plot3(initial.xs(),initial.ys(),initial.zs(),'g-*');
|
||||||
|
|
||||||
%% optimize
|
%% optimize
|
Loading…
Reference in New Issue