Merge pull request #2 from twiniars/master

cartesian generator changes
implement proper action interface for CartesianImpedanceAction.
add wrench constraint.
fix interpolation of last trajectory segment.
cartesian trajectory interpolator fix