fixed traj controller gains
Merge branch 'groovy' of https://github.com/kth-ros-pkg/dumbo_robot into groovy