CostVis:

--------------------------------------------------------------------------
   Visualize the cost to achieve each target state on the trajectory.

   Since version 7.
--------------------------------------------------------------------------
   Usage:
   CostVis( r, cost )
--------------------------------------------------------------------------

   ------
   Inputs
   ------
   r            (3,N)  3D state vector over N time steps
   cost         (1,N)  Cost over N time steps

   -------
   Outputs
   -------
   none
   
--------------------------------------------------------------------------