PlotTrajectory

 Plots the trajectory.

 Plots a trajectory, T.

 One optional parameter is used decide wether to plot arrow indicating 
 the orientation of the robot at each step. If not given the orientation 
 is not plotted.

 Trajectories are always plotted in blue.   

 Returns the handler of the line representing the trajectory.

0001 function h=PlotTrajectory(T,varargin)
0002 % Plots the trajectory.
0003 %
0004 % Plots a trajectory, T.
0005 %
0006 % One optional parameter is used decide wether to plot arrow indicating
0007 % the orientation of the robot at each step. If not given the orientation
0008 % is not plotted.
0009 %
0010 % Trajectories are always plotted in blue.
0011 %
0012 % Returns the handler of the line representing the trajectory.
0013 
0014   if (nargin>1)
0015     arrows=varargin{1};
0016   else
0017     arrows=false;
0018   end
0019   
0020   h=PlotPoseSequence(T.data,'b',arrows);
0021 
0022   
0023