adds trajectory lookup
adds velocity copying to RobotTrajectory lookup
removes obsolete commented stuff
cleanup API of trajectory lookup
Merge pull request #51 from aleeper/trajectory_lookup

state lookup utility for robot_trajectory