Updates per review #22

Optimization for time calculations.
Merge pull request #26 from RethinkRobotics/joint_trajectory_review

Updates per review #22