void HrpsysSeqStateROSBridge::onJointTrajectoryActionGoal() {
    pr2_controllers_msgs::JointTrajectoryGoalConstPtr goal = joint_trajectory_server.acceptNewGoal();
    onJointTrajectory(goal->trajectory);
}
void HrpsysSeqStateROSBridge::onFollowJointTrajectoryActionGoal() {
    control_msgs::FollowJointTrajectoryGoalConstPtr goal = follow_joint_trajectory_server.acceptNewGoal();
    follow_action_initialized = true;
    onJointTrajectory(goal->trajectory);
}
void HrpsysJointTrajectoryBridge::jointTrajectoryActionObj::onFollowJointTrajectoryActionGoal()
{
  ROS_INFO_STREAM("[" << parent->getInstanceName() << "] @onFollowJointTrajectoryActionGoal()");
  control_msgs::FollowJointTrajectoryGoalConstPtr goal = follow_joint_trajectory_server->acceptNewGoal();
  onJointTrajectory(goal->trajectory);
}