add follow_joint_trajectory/feedback message publish

this enables to publish follow_joint_trajectory/feedback topic when controller is moving.