plotTrajectory Visualize the output of HebiTrajectory.
 
    This method visualizes position, velocity, and acceleration
    of a HebiTrajectory.
 
    Arguments:
 
        trajectory  - HebiTrajectory that should be plotted
 
    Parameters:
 
        'dt' is the timestep used for plotting, in seconds. The
        default value if left unspecified is 0.01 seconds.
 
        'FigNum' is the figure number or figure handle that
        should be used for plotting. If a figure with the
        specified number exists it will be overwritten. If left
        unspecified, a new figure will automatically be
        generated.
 
        'Legend' is a string or cell array of the text that gets
        displayed as the legend. By default it shows the joint
        number.
 
    Examples:
        % Visualize trajectory moving through 5 random waypoints
        velocityLimit = [-10 10];
        trajGen = HebiTrajectoryGenerator(velocityLimit);
        trajGen.setMinDuration(0.1);
        positions = 2*pi * rand(5,1);
 
        traj = trajGen.newJointMove(positions);
        figHandle = HebiUtils.plotTrajectory(traj,'FigNum',101);