Check waypoint timing

A precondition for all trajectories executed by the
joint_trajectory_controller is that waypoints must have strictly
increasing reach times. This changeset validates the precondition and
rejects commands that don't satisfy it.