use default vel instead of default point time
fix traj time calculation
Merge pull request #12 from ipa-cob4-2/indigo_dev

merge-Indigo dev