Added notifications and timeouts to trajectory server. Trajectories working with hard-coded timeouts.