Set time_from_start to feedback of joint trajectory action

[pazeshun]

For jsk-ros-pkg/jsk_pr2eus#233 (comment)
Complement #966

Note:
Feedback from HrpsysSeqStateROSBridge(fullbody_controller) always comes after first joint trajectory, so its time_from_start increases until next trajectory comes.
On the other hand, feedback from HrpsysJointTrajectoryBridge(rarm_controller etc.) stops when each trajectory is completely executed.

[pazeshun]

@k-okada

Feedback from HrpsysSeqStateROSBridge(fullbody_controller) always comes after first joint trajectory

This behaviour is correct? If not, I want to fix this behaviour in this PR.

[pazeshun]

Feedback from HrpsysSeqStateROSBridge(fullbody_controller) always comes after first joint trajectory

This behaviour is correct? If not, I want to fix this behaviour in this PR.

I think this behaviour is bug, so I fixed this.

The reason of this behaviour is one publishFeedback is outside if block of follow_joint_trajectory_server.isActive() (https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/src/HrpsysSeqStateROSBridge.cpp#L578 ).
Other publishFeedbacks are inside that if block:
https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/src/HrpsysSeqStateROSBridge.cpp#L507-L510
https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/src/HrpsysSeqStateROSBridge.cpp#L512-L519
https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/src/HrpsysJointTrajectoryBridge.cpp#L350-L353
https://github.com/start-jsk/rtmros_common/blob/1.4.2/hrpsys_ros_bridge/src/HrpsysJointTrajectoryBridge.cpp#L356-L366

[pazeshun]

@Affonso-Gui Please use this.

[Affonso-Gui]

@pazeshun Thanks. Looking forward to being merged.

[Affonso-Gui]

@k-okada Can we merge this? It has been approved and passes the checks.

[pazeshun]

Moved to #1073