progress on FollowJointTrajectory action server