Merge pull request #1 from twiniars/hydro-devel

Motor and joint spline interpolation
assume 0 velocity and acceleration at begining of trajectory.
fix time measurement.
fix interpolation of last segment.
spline trajectory fix