parameters: (traj,robot,ees,width=2,color=(1,0.5,0,1),pointSize=None,pointColor=None)
docstring: Draws trajectories for the robot's end effectors.  Note: no additional discretization is performed,
      only the end effector points at the trajectory's milestones are shown.  If you want more accurate trajectories,
      first call traj.discretize(eps).
docstring_summary: Draws trajectories for the robot's end effectors.  Note: no additional discretization is performed,
      only the end effector points at the trajectory's milestones are shown.  If you want more accurate trajectories,
      first call traj.discretize(eps).
docstring_tokens: Draws trajectories for the robot s end effectors . Note : no additional discretization is performed only the end effector points at the trajectory s milestones are shown . If you want more accurate trajectories first call traj . discretize ( eps ) .
function: def drawRobotTrajectory(traj,robot,ees,width=2,color=(1,0.5,0,1),pointSize=None,pointColor=None):
      """Draws trajectories for the robot's end effectors.  Note: no additional discretization is performed,
      only the end effector points at the trajectory's milestones are shown.  If you want more accurate trajectories,
      first call traj.discretize(eps)."""
      for i,ee in enumerate(ees):
          if ee < 0: ees[i] = robot.numLinks()-1
      pointTrajectories = []
      for ee in ees:
          pointTrajectories.append([])
      if isinstance(traj,Trajectory):
          traj = traj.milestones
      for m in traj:
          robot.setConfig(m)
          for ee,eetraj in zip(ees,pointTrajectories):
              eetraj.append(robot.link(ee).getTransform()[1])
      for ptraj in pointTrajectories:
          drawTrajectory(ptraj,width,color,pointSize,pointColor)
function_tokens: def drawRobotTrajectory ( traj , robot , ees , width = 2 , color = ( 1 , 0.5 , 0 , 1 ) , pointSize = None , pointColor = None ) : for i , ee in enumerate ( ees ) : if ee < 0 : ees [ i ] = robot . numLinks ( ) - 1 pointTrajectories = [ ] for ee in ees : pointTrajectories . append ( [ ] ) if isinstance ( traj , Trajectory ) : traj = traj . milestones for m in traj : robot . setConfig ( m ) for ee , eetraj in zip ( ees , pointTrajectories ) : eetraj . append ( robot . link ( ee ) . getTransform ( ) [ 1 ] ) for ptraj in pointTrajectories : drawTrajectory ( ptraj , width , color , pointSize , pointColor )