2012-06-05 21:29:26 +08:00
|
|
|
function plotPoint2(p,color,P)
|
2012-09-08 13:28:25 +08:00
|
|
|
% plotPoint2 shows a Point2, possibly with covariance matrix
|
2012-06-05 21:29:26 +08:00
|
|
|
if size(color,2)==1
|
|
|
|
plot(p.x,p.y,[color '*']);
|
|
|
|
else
|
|
|
|
plot(p.x,p.y,color);
|
|
|
|
end
|
2012-07-24 06:15:05 +08:00
|
|
|
if exist('P', 'var')
|
2012-08-04 05:02:45 +08:00
|
|
|
gtsam.covarianceEllipse([p.x;p.y],P,color(1));
|
2012-06-05 21:29:26 +08:00
|
|
|
end
|