Action server trajectory playback capability added.

This needs testing with the robot.