position trajectory tests done
Merge branch 'actionlib'