Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

gazeboでhrp2が歩かない問題 #503

Open
otsubo opened this issue Feb 21, 2017 · 37 comments
Open

gazeboでhrp2が歩かない問題 #503

otsubo opened this issue Feb 21, 2017 · 37 comments

Comments

@otsubo
Copy link

otsubo commented Feb 21, 2017

先週の研究会で少し話にあった内容なのですが,最近gazeboでhrp2が歩かないようになってた
問題を少し調べていて,start-jsk/rtmros_gazebo#217 このイシューの最後でご指摘していただいた通り,#419 このプルリクぐらいまで戻すと,問題なく歩きました.何が原因かはっきりわかっていないのですが,何かわかりましたら,またご報告いたします.

@mmurooka
Copy link
Member

ホントですね.最新版だと歩いてすぐ転ぶけれど,#419 まで戻すと問題なく歩きます.

@mmurooka
Copy link
Member

@k-okada, @YoheiKakiuchi , @snozawa

hrpsys起動時に,hrp2_hrpsys_config.py でstのパラメータをセットしていますが,
セットすると転んで,セットしなければ(デフォルトのままにすれば)歩けることがわかりました.
(rtmros_tutorialsのバージョンを戻して歩けていた理由は,
前のバージョンではstのidlが合わなくてstのパラメータをセットできなかったからでした.)

rtmros_common, rtmros_tutorials, rtmros_gazeboは最新で,
例えばhrp2jsknt(hrp2017)の場合は
https://github.com/start-jsk/rtmros_tutorials/blob/master/hrpsys_ros_bridge_tutorials/src/hrpsys_ros_bridge_tutorials/hrp2_hrpsys_config.py#L144
の一行ををコメントアウトすれば歩けます.

@mmurooka
Copy link
Member

@snozawa
Copy link
Collaborator

snozawa commented Mar 11, 2017

@otsubo さん
ごめんなさい、こちら見落としてました。

@mmurooka さん
現象としては、

  • #419まで戻しても、hrpsys_ros_bridge_tutorialsのpython設定が実機と同じ状態だと歩かない
  • #419まで戻してかつpython設定を行わないと歩く

というのであってますか?

動いているときに
(send *ri* :get-st-algorithm)
を実行してみてもらえると助かります。

TPCCとかが帰ってくる場合、このSTの制御則であるいているということになります。
以前から、辛うじてgazeboであるけているのが確認されてるのはこのモードで、
今の実機とhrpsys-simulator系はTPCC以外の制御則であるいているので、
TPCC以外+実機と同じパラメタで何とか歩かないか、というのがこれまでの経緯でした。
なので、TPCC以外+実機と同じパラメタで歩けるとうれしい。

また、歩けない条件のときは、具体的にどのコマンドをうつとどうなりますか?
(send *ri* :start-st)
の時点でこける?発振する?
歩くまではなんとか持ちこたえてて歩くとダメ?

@mmurooka
Copy link
Member

現象としては、
#419まで戻しても、hrpsys_ros_bridge_tutorialsのpython設定が実機と同じ状態だと歩かない
#419まで戻してかつpython設定を行わないと歩く
というのであってますか?

はい,だいたいそうなります.
#419 まで戻すとhrp2_hrpsys_config.pyでセットするstのパラメータが最新のhrpsysと異なるため(stのパラメータの中でemergency stopのマージンがスカラーかベクトルか異なる),その状態ではstの設定を変えることはできないです.

  • #419まで戻して,hrp2_hrpsys_config.pyのみ最新にして実機と同じ設定にすると歩かない
  • #419まで戻してかつpython設定を行わないと歩く(#419にした時点でstのパラメータは異なるのでそのままでもエラーでセットされない)

ことを確認しました.

動いているときに
(send ri :get-st-algorithm)
を実行してみてもらえると助かります。

tpccでした.このときの歩き方は少し試した限りではあんまり危なげではなさそうでした.

転び方は,
https://drive.google.com/file/d/0B5qanGnXorOuY2t3S3NYT2ZmbG8/view
の45秒あたりのように,start-stをした時点で後ろ向きや前向きに足首が回って転びます.

@snozawa
Copy link
Collaborator

snozawa commented Mar 12, 2017

#419まで戻して,hrp2_hrpsys_config.pyのみ最新にして実機と同じ設定にすると歩かない

これは、適切にpythonセッティングをしてパラメタがセットされるのを確認しても
あるかないということだよね?

#419 まで戻すとhrp2_hrpsys_config.pyでセットするstのパラメータが最新のhrpsysと異なるため(stのパラメータの中でemergency stopのマージンがスカラーかベクトルか異なる),その状態ではstの設定を変えることはできないです.

これがよくわからなかったんだけど、#419はrtmros_gazeboのPRであって、
hrpsysや、hrp2_hrpsys_config.pyといったものとリポジトリが違うので、
rtmros_gazeboを向かしにもどしてもhrpsysやhrp2_config_pyは変わらないので
こういう状況が起こらないと思うんだけど、違うのかな?

@mmurooka
Copy link
Member

これは、適切にpythonセッティングをしてパラメタがセットされるのを確認しても
あるかないということだよね?

そうです.

これがよくわからなかったんだけど、#419はrtmros_gazeboのPRであって、
hrpsysや、hrp2_hrpsys_config.pyといったものとリポジトリが違うので、
rtmros_gazeboを向かしにもどしてもhrpsysやhrp2_config_pyは変わらないので
こういう状況が起こらないと思うんだけど、違うのかな?

rtmros_tutorialsのPRです.(hrpsys_gazebo_tutorialsはrtmros_tutorialsにあります.)
という理解でもう一度読み返していただければお分かりいただけるかと思います.

@snozawa
Copy link
Collaborator

snozawa commented Mar 12, 2017

rtmros_tutorialsのPRです.(hrpsys_gazebo_tutorialsはrtmros_tutorialsにあります.)
という理解でもう一度読み返していただければお分かりいただけるかと思います.

なるほど、わかりました。

@iory
Copy link
Contributor

iory commented Apr 5, 2017

具体的にgazeboを使って歩くことを試してみました.
https://github.com/start-jsk/rtmros_tutorials/blob/master/hrpsys_ros_bridge_tutorials/src/hrpsys_ros_bridge_tutorials/hrp2_hrpsys_config.py#L82
https://github.com/start-jsk/rtmros_tutorials/blob/master/hrpsys_ros_bridge_tutorials/src/hrpsys_ros_bridge_tutorials/hrp2_hrpsys_config.py#L181
https://github.com/start-jsk/rtmros_tutorials/blob/master/hrpsys_ros_bridge_tutorials/src/hrpsys_ros_bridge_tutorials/hrp2_hrpsys_config.py#L278

stp.st_algorithm=OpenHRP.StabilizerService.EEFMQPCOPを
stp.st_algorithm=OpenHRP.StabilizerService.TTPCに変更後,gazeboを立ち上げる

roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch
rtmlaunch hrpsys_gazebo_tutorials hrp2jsknts_hrpsys_bringup.launch

roseusで

roseus
(load "package://hrpsys_ros_bridge_tutorials/euslisp/hrp2jsknts-interface.l")
(hrp2jsknts-init)
(setq *robot* *hrp2jsknts*)
(send *ri* :start-st)
(send *ri* :angle-vector (send *robot* :angle-vector) 4000)
(send *ri* :start-auto-balancer)
(send *ri* :go-pos 1 0 0)

で歩きます.start-stの前にreset-poseにすると,何故かHRP2が回転してしまいますので,
順番が大事です.

@snozawa
Copy link
Collaborator

snozawa commented Apr 5, 2017

これ何目標でやってますか?
なんでも良いのでgazeboでgo-posくらいができる動画がとれればよいのと、普通にあるけるようにするのと、
普通に実機でやっているデモなどがうごいて透過的に使えるようにするのとで、色々違ってくるかなと思います。
それで、TPCCは実機では使われてなくて、また実機のEEFMほげほげのような制御モードとけっこう違いがあります。
後者2つもしくは一番最後の項目くらいを狙うなら、
「歩きました」=「実機と同じ制御構成、(ほぼ)同じパラメタで歩きました」を調べたら良いと思います。
(後者2つが目標なら、実機いろいろ違うものを作って、動きます、というのは避けたいところ)

#503 (comment)
をはじめみたときは、kinematicsモードみたいなのを摘要する前に戻したら
いいかんじになるのかと思ったけど、後々きいてそうじゃないらしい、というのが分かりました。

start-stの前にreset-poseにすると,何故かHRP2が回転してしまいますので,順番が大事です.

これはなんでだろうね。
前より状況が悪化してそうですね。
パラメタが何があって、何を調整してみてるかを共有すると良さそうですね。

@snozawa
Copy link
Collaborator

snozawa commented Apr 5, 2017

あと、動画もあるとわかりやすそうですね。

@iory
Copy link
Contributor

iory commented Apr 5, 2017

これ何目標でやってますか?

動作獲得の学習のために,simulator上で試行ができるといいと思っているので,
そこが目標です.プラス,他のデモなどもgazebo上で再現できるようになるといいです.
なので,後者2つが目標です.

なので,

「歩きました」=「実機と同じ制御構成、(ほぼ)同じパラメタで歩きました」を調べたら良いと思います。

をやっていくのかと思います.

これはなんでだろうね。
前より状況が悪化してそうですね。

reset-pose -> st 回転する
reset-pose -> st -> auto-balancer 回転しない
https://drive.google.com/open?id=0B_NiLAzvehC9TjkxcXMwemt6bmc
ということがわかりました.

ttpcで,st -> auto-balancer -> gopos
https://drive.google.com/open?id=0B_NiLAzvehC9bl9aOG12X1BZeGM

EEFMQPCOP -> auto-balancer -> gopos
https://drive.google.com/open?id=0B_NiLAzvehC9NS1zYWhFY19pZW8

@snozawa
Copy link
Collaborator

snozawa commented Apr 5, 2017

  <world name="default">
    <physics type="ode">
      <gravity>0 0 -9.80665</gravity>
      <max_step_size>0.001</max_step_size>
      <real_time_factor>1</real_time_factor>
      <real_time_update_rate>1000</real_time_update_rate>
      <ode>
        <solver>
          <type>world</type>
        </solver>
        <constraints>
          <cfm>1e-7</cfm>
          <erp>1e-2</erp>
        </constraints>
      </ode>
    </physics>
  </world>

ODEのquickをworldにするのを試したことがないので、
上記を適宜empty.worldかなにかにうつしてためせたりするかな?
http://answers.gazebosim.org/question/232/gazebo-physics-solver-type-quick-vs-world/

@snozawa
Copy link
Collaborator

snozawa commented Apr 5, 2017

動作獲得の学習のために,simulator上で試行ができるといいと思っているので,そこが目標です.

これいいですね、ぜひやりましょう。

あと先ほど口頭で伝えましたが
start-auto-balancer->start-stの純で起動してみてください

@iory
Copy link
Contributor

iory commented Apr 6, 2017

ODEのquickをworldにするのを試したことがないので、
上記を適宜empty.worldかなにかにうつしてためせたりするかな?
start-auto-balancer->start-stの純で起動してみてください

quick -> worldに変更してみましたが,
EEFMQPCOPの挙動は変わらず,auto-balancerを入れても倒れず,
次にstを入れた時点で倒れました.

@YoheiKakiuchi さんから聞いたことをメモとして書きますと,
choreonoidだと足裏と地面の間にブッシュ要素があって,
それを入れないと歩かないということでした.
あとは,inertiaのリンク間の差が0.001 ~ 1000倍以下でないと,
加速度がかかった時に大きな力がかかり,その部分が吹っ飛び,それにつられて体全体も,
飛んでしまうということでした.
ですが,このinertiaのチェックは行っているとのことなので,
あとは他のパラメータの調整になるのかなと思います.

@iory
Copy link
Contributor

iory commented Apr 6, 2017

すいません.

quick -> worldに変更してみましたが,
EEFMQPCOPの挙動は変わらず,auto-balancerを入れても倒れず,
次にstを入れた時点で倒れました.

ちゃんと変更できていなくて,
worldにすると
collisiondetectorが見つからないというwarningが出るので,
stを入れられないので,
原因を検証します.

rtmlaunch hrpsys_gazebo_tutorials hrp2jsknts_hrpsys_bringup.launch
[rtmlaunch] Start omniNames at port 15005

Thu Apr  6 14:48:54 2017:

Starting omniNames for the first time.
Wrote initial log file.
Read log file successfully.
Root context is IOR:010000002b00000049444c3a6f6d672e6f72672f436f734e616d696e672f4e616d696e67436f6e746578744578743a312e300000010000000000000070000000010102000e0000003139322e3136382e39372e3732009d3a0b0000004e616d6553657276696365000300000000000000080000000100000000545441010000001c000000010000000100010001000000010001050901010001000000090101000354544108000000c6d6e5580100336b
Checkpointing Phase 1: Prepare.
Checkpointing Phase 2: Commit.
Checkpointing completed.
... logging to /home/iory/.ros/log/9d039dfe-1a88-11e7-8bf9-d050996634a1/roslaunch-valkyrie-13157.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
WARNING: disk usage in log directory [/home/iory/.ros/log] is over 1GB.
It's recommended that you use the 'rosclean' command.

started roslaunch server http://133.11.216.78:39249/

SUMMARY
========

PARAMETERS
 * /HrpsysSeqStateROSBridge/publish_sensor_transforms: True
 * /controller_configuration: [{'group_name': '...
 * /diagnostic_aggregator/analyzers/computers/contains: ['HD Temp', 'CPU ...
 * /diagnostic_aggregator/analyzers/computers/path: Computers
 * /diagnostic_aggregator/analyzers/computers/type: diagnostic_aggreg...
 * /diagnostic_aggregator/analyzers/hrpsys/contains: ['hrpEC', 'Emerge...
 * /diagnostic_aggregator/analyzers/hrpsys/path: Hrpsys
 * /diagnostic_aggregator/analyzers/hrpsys/type: diagnostic_aggreg...
 * /diagnostic_aggregator/analyzers/mode/contains: ['Operating Mode'...
 * /diagnostic_aggregator/analyzers/mode/path: Mode
 * /diagnostic_aggregator/analyzers/mode/type: diagnostic_aggreg...
 * /diagnostic_aggregator/analyzers/motor/contains: ['Motor']
 * /diagnostic_aggregator/analyzers/motor/path: Motor
 * /diagnostic_aggregator/analyzers/motor/type: diagnostic_aggreg...
 * /diagnostic_aggregator/base_path:
 * /diagnostic_aggregator/pub_rate: 1.0
 * /robot_pose_ekf/debug: False
 * /robot_pose_ekf/freq: 30.0
 * /robot_pose_ekf/imu_used: False
 * /robot_pose_ekf/odom_used: True
 * /robot_pose_ekf/output_frame: odom
 * /robot_pose_ekf/self_diagnose: False
 * /robot_pose_ekf/sensor_timeout: 1.0
 * /robot_pose_ekf/vo_used: False
 * /rosdistro: indigo
 * /rosversion: 1.11.20

NODES
  /
    AutoBalancerServiceROSBridge (hrpsys_ros_bridge/AutoBalancerServiceROSBridgeComp)
    CollisionDetectorServiceROSBridge (hrpsys_ros_bridge/CollisionDetectorServiceROSBridgeComp)
    DataLoggerServiceROSBridge (hrpsys_ros_bridge/DataLoggerServiceROSBridgeComp)
    ForwardKinematicsServiceROSBridge (hrpsys_ros_bridge/ForwardKinematicsServiceROSBridgeComp)
    HrpsysJointTrajectoryBridge (hrpsys_ros_bridge/HrpsysJointTrajectoryBridge)
    HrpsysSeqStateROSBridge (hrpsys_ros_bridge/HrpsysSeqStateROSBridge)
    ImpedanceControllerServiceROSBridge (hrpsys_ros_bridge/ImpedanceControllerServiceROSBridgeComp)
    KalmanFilterServiceROSBridge (hrpsys_ros_bridge/KalmanFilterServiceROSBridgeComp)
    RemoveForceSensorLinkOffsetServiceROSBridge (hrpsys_ros_bridge/RemoveForceSensorLinkOffsetServiceROSBridgeComp)
    RobotHardwareServiceROSBridge (hrpsys_ros_bridge/RobotHardwareServiceROSBridgeComp)
    SequencePlayerServiceROSBridge (hrpsys_ros_bridge/SequencePlayerServiceROSBridgeComp)
    SoftErrorLimiterServiceROSBridge (hrpsys_ros_bridge/SoftErrorLimiterServiceROSBridgeComp)
    StabilizerServiceROSBridge (hrpsys_ros_bridge/StabilizerServiceROSBridgeComp)
    StateHolderServiceROSBridge (hrpsys_ros_bridge/StateHolderServiceROSBridgeComp)
    base_footprint_rootlink (tf/static_transform_publisher)
    collision_state (hrpsys_ros_bridge/collision_state.py)
    diagnostic_aggregator (diagnostic_aggregator/aggregator_node)
    hrpsys (openrtm_aist/rtcd)
    hrpsys_profile (hrpsys_ros_bridge/hrpsys_profile.py)
    hrpsys_py (hrpsys_ros_bridge_tutorials/hrp2jsknts_hrpsys_config.py)
    hrpsys_ros_diagnostics (hrpsys_ros_bridge/diagnostics.py)
    modelloader (openhrp3/openhrp-model-loader)
    robot_pose_ekf (robot_pose_ekf/robot_pose_ekf)
    rtmlaunch_hrpsys_ros_bridge (openrtm_tools/rtmlaunch.py)
    sensor_ros_bridge_connect (hrpsys_ros_bridge/sensor_ros_bridge_connect.py)

WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtconnect
WARNING: unrecognized tag rtactivate
ROS_MASTER_URI=http://localhost:11311

core service [/rosout] found
process[modelloader-1]: started with pid [13181]
process[hrpsys-2]: started with pid [13182]
ready
process[hrpsys_py-3]: started with pid [13199]
process[HrpsysSeqStateROSBridge-4]: started with pid [13204]
hrpExecutionContext is registered
RobotHardware0: joint command velocity check is disabled
process[HrpsysJointTrajectoryBridge-5]: started with pid [13205]
loading file:///home/iory/catkin_ws/recognition/src/rtm-ros-robotics/rtmros_hrp2/hrp2_models/HRP2JSKNTS_for_OpenHRP3/HRP2JSKNTSmain.wrl
process[hrpsys_ros_diagnostics-6]: started with pid [13207]
process[diagnostic_aggregator-7]: started with pid [13214]
process[hrpsys_profile-8]: started with pid [13228]
process[sensor_ros_bridge_connect-9]: started with pid [13253]
Humanoid node
Joint node WAIST
  Segment node BODY
  Joint node RLEG_JOINT0
      Segment node RLEG_LINK0
      Joint node RLEG_JOINT1
          Segment node RLEG_LINK1
          Joint node RLEG_JOINT2
              Segment node RLEG_LINK2
              Joint node RLEG_JOINT3
                  Segment node RLEG_LINK3
                  Joint node RLEG_JOINT4
                      Segment node RLEG_LINK4
                      Joint node RLEG_JOINT5
                          Segment node RLEG_LINK5
                            ForceSensorrfsensor
                          Joint node RLEG_JOINT6
                            Segment node RLEG_LINK6
  Joint node LLEG_JOINT0
      Segment node LLEG_LINK0
      Joint node LLEG_JOINT1
          Segment node LLEG_LINK1
          Joint node LLEG_JOINT2
              Segment node LLEG_LINK2
              Joint node LLEG_JOINT3
                  Segment node LLEG_LINK3
                  Joint node LLEG_JOINT4
                      Segment node LLEG_LINK4
                      Joint node LLEG_JOINT5
                          Segment node LLEG_LINK5
                            ForceSensorlfsensor
                          Joint node LLEG_JOINT6
                            Segment node LLEG_LINK6
  Joint node CHEST_JOINT0
      Segment node CHEST_LINK0
      Joint node CHEST_JOINT1
          Segment node CHEST_LINK1
            AccelerationSensorgsensor
            Gyrogyrometer
          Joint node HEAD_JOINT0
              Segment node HEAD_LINK0
              Joint node HEAD_JOINT1
                  Segment node HEAD_LINK1
                  VisionSensorCARMINE
          Joint node RARM_JOINT0
              Segment node RARM_LINK0
              Joint node RARM_JOINT1
                  Segment node RARM_LINK1
                  Joint node RARM_JOINT2
                      Segment node RARM_LINK2
                      Joint node RARM_JOINT3
                          Segment node RARM_LINK3
                          Joint node RARM_JOINT4
                              Segment node RARM_LINK4
                              Joint node RARM_JOINT5
                                  Segment node RARM_LINK5
                                  Joint node RARM_JOINT6
                                      Segment node RARM_LINK6
                                        ForceSensorrhsensor
                                      Joint node RARM_JOINT7
                                          Segment node RARM_LINK7
          Joint node LARM_JOINT0
              Segment node LARM_LINK0
              Joint node LARM_JOINT1
                  Segment node LARM_LINK1
                  Joint node LARM_JOINT2
                      Segment node LARM_LINK2
                      Joint node LARM_JOINT3
                          Segment node LARM_LINK3
                          Joint node LARM_JOINT4
                              Segment node LARM_LINK4
                              Joint node LARM_JOINT5
                                  Segment node LARM_LINK5
                                  Joint node LARM_JOINT6
                                      Segment node LARM_LINK6
                                        ForceSensorlhsensor
                                      Joint node LARM_JOINT7
                                          Segment node LARM_LINK7
process[rtmlaunch_hrpsys_ros_bridge-10]: started with pid [13255]
process[SequencePlayerServiceROSBridge-11]: started with pid [13257]
Warning: Mass is zero. <Model>HRP2JSKNTS <Link>RARM_JOINT7
Warning: Mass is zero. <Model>HRP2JSKNTS <Link>LARM_JOINT7
process[DataLoggerServiceROSBridge-12]: started with pid [13280]
The model was successfully loaded !
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleBushCustomizer.so" for
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleCustomizer.so" for springJoint
[RobotHardware] loadGain
[RobotHardware]   RLEG_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT2, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT3, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT4, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT5, pgain = 1, dgain = 1
[RobotHardware]   RLEG_JOINT6, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT2, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT3, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT4, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT5, pgain = 1, dgain = 1
[RobotHardware]   LLEG_JOINT6, pgain = 1, dgain = 1
[RobotHardware]   CHEST_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   CHEST_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   HEAD_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   HEAD_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT2, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT3, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT4, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT5, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT6, pgain = 1, dgain = 1
[RobotHardware]   RARM_JOINT7, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT0, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT1, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT2, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT3, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT4, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT5, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT6, pgain = 1, dgain = 1
[RobotHardware]   LARM_JOINT7, pgain = 1, dgain = 1
;; IOB / set num of joint = 34
;; set_number_of_force_sensors = 4
;; set_number_of_gyro_sensors = 1
;; set_number_of_number_of_accelerometers = 1
[iob] Open IOB / start
[iob] set node name : hrpsys_gazebo_iob
process[ForwardKinematicsServiceROSBridge-13]: started with pid [13305]
process[StateHolderServiceROSBridge-14]: started with pid [13315]
process[RobotHardwareServiceROSBridge-15]: started with pid [13337]
configuration ORB with localhost:15005
[hrpsys.py] waiting ModelLoader
[hrpsys.py] start hrpsys
[hrpsys.py] finding RTCManager and RobotHardware
process[AutoBalancerServiceROSBridge-16]: started with pid [13360]
process[StabilizerServiceROSBridge-17]: started with pid [13364]
[sensor_ros_bridge_connect.py]  start
configuration ORB with localhost:15005
[sensor_ros_bridge_connect.py]  waitForRTCManagerAndRoboHardware has renamed to waitForRTCManagerAndRoboHardware: Please update your code
process[KalmanFilterServiceROSBridge-18]: started with pid [13391]
process[CollisionDetectorServiceROSBridge-19]: started with pid [13413]
process[collision_state-20]: started with pid [13428]
process[ImpedanceControllerServiceROSBridge-21]: started with pid [13451]
process[RemoveForceSensorLinkOffsetServiceROSBridge-22]: started with pid [13456]
process[SoftErrorLimiterServiceROSBridge-23]: started with pid [13470]
process[robot_pose_ekf-24]: started with pid [13476]
process[base_footprint_rootlink-25]: started with pid [13505]
loading file:///home/iory/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_tutorials/hrpsys_ros_bridge_tutorials/models/HRP2JSKNTS.dae
[rtmlaunch] starting...  /home/iory/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_common/hrpsys_ros_bridge/launch/hrpsys_ros_bridge.launch
Collada Warning: fill asset info
[rtmlaunch] RTCTREE_NAMESERVERS localhost:15005 localhost:15005
[rtmlaunch] SIMULATOR_NAME RobotHardware0
[rtmlaunch] check connection/activation
[rtmlaunch] Wait for  /localhost:15005/RobotHardware0.rtc:q   0 /30
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: joint RLEG_JOINT6 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RLEG_JOINT5 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint RLEG_JOINT4 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RLEG_JOINT3 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RLEG_JOINT2 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RLEG_JOINT1 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint RLEG_JOINT0 has axis: 0.000000 0.000000 1.000000
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: joint LLEG_JOINT6 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LLEG_JOINT5 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint LLEG_JOINT4 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LLEG_JOINT3 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LLEG_JOINT2 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LLEG_JOINT1 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint LLEG_JOINT0 has axis: 0.000000 0.000000 1.000000
Collada Warning: joint HEAD_JOINT1 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint HEAD_JOINT0 has axis: 0.000000 0.000000 1.000000
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: joint RARM_JOINT7 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint RARM_JOINT6 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RARM_JOINT5 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint RARM_JOINT4 has axis: 0.000000 0.000000 1.000000
Collada Warning: joint RARM_JOINT3 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint RARM_JOINT2 has axis: 0.000000 0.000000 1.000000
Collada Warning: joint RARM_JOINT1 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint RARM_JOINT0 has axis: 0.000000 1.000000 0.000000
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: generate normals from vertices
Collada Warning: joint LARM_JOINT7 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint LARM_JOINT6 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LARM_JOINT5 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint LARM_JOINT4 has axis: 0.000000 0.000000 1.000000
Collada Warning: joint LARM_JOINT3 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint LARM_JOINT2 has axis: 0.000000 0.000000 1.000000
Collada Warning: joint LARM_JOINT1 has axis: 1.000000 0.000000 0.000000
Collada Warning: joint LARM_JOINT0 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint CHEST_JOINT1 has axis: 0.000000 1.000000 0.000000
Collada Warning: joint CHEST_JOINT0 has axis: 0.000000 0.000000 1.000000
Collada Warning: cannot find instance_actuator for attached sensor HRP2JSKNTS:WAIST
The model was successfully loaded !
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleBushCustomizer.so" for
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleCustomizer.so" for springJoint
cache found for file:///home/iory/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_tutorials/hrpsys_ros_bridge_tutorials/models/HRP2JSKNTS.dae
duplicated sensor Id is specified(id = 0, name = rfsensor)
duplicated sensor Id is specified(id = 1, name = lfsensor)
duplicated sensor Id is specified(id = 0, name = CARMINE)
duplicated sensor Id is specified(id = 2, name = rhsensor)
duplicated sensor Id is specified(id = 3, name = lhsensor)
duplicated sensor Id is specified(id = 0, name = gsensor)
duplicated sensor Id is specified(id = 0, name = gyrometer)
[ INFO] [1491457735.203115351]: [HrpsysJointTrajectoryBridge] @Initilize name : HrpsysJointTrajectoryBridge0 done
configuration ORB with localhost:15005
[WARN] [WallTime: 1491457735.318038] [0.000000] Could not found CollisionDetector(co), waiting...
iob::period 4000000
[iob]  34 / 46 / 46
[iob] block until subscribing first robot_state.[ WARN] [1491457735.595345928]: [HrpsysSeqStateROSBridge] use_hrpsys_time
[ INFO] [1491457735.608250765]: [HrpsysSeqStateROSBridge] @Initilize name : HrpsysSeqStateROSBridge0
cache found for file:///home/iory/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_tutorials/hrpsys_ros_bridge_tutorials/models/HRP2JSKNTS.dae
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleBushCustomizer.so" for
Loading body customizer "/opt/ros/indigo/share/OpenHRP-3.1/customizer/libSampleCustomizer.so" for springJoint
cache found for file:///home/iory/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_tutorials/hrpsys_ros_bridge_tutorials/models/HRP2JSKNTS.dae
duplicated sensor Id is specified(id = 0, name = rfsensor)
duplicated sensor Id is specified(id = 1, name = lfsensor)
duplicated sensor Id is specified(id = 0, name = CARMINE)
duplicated sensor Id is specified(id = 2, name = rhsensor)
duplicated sensor Id is specified(id = 3, name = lhsensor)
duplicated sensor Id is specified(id = 0, name = gsensor)
duplicated sensor Id is specified(id = 0, name = gyrometer)
0 physical force sensor : rfsensor
1 physical force sensor : lfsensor
2 physical force sensor : rhsensor
3 physical force sensor : lhsensor
0 acceleration sensor : gsensor
0 rate sensor : gyrometer
[HrpsysSeqStateROSBridge0] End Effector [rleg]RLEG_JOINT6 WAIST
[HrpsysSeqStateROSBridge0]   target = RLEG_LINK5, sensor_name = rfsensor
[HrpsysSeqStateROSBridge0]   localPos =     [-0.079411,  -0.01,  -0.034][m]
[HrpsysSeqStateROSBridge0] End Effector [lleg]LLEG_JOINT6 WAIST
[HrpsysSeqStateROSBridge0]   target = LLEG_LINK5, sensor_name = lfsensor
[HrpsysSeqStateROSBridge0]   localPos =     [-0.079411,  0.01,  -0.034][m]
[HrpsysSeqStateROSBridge0] End Effector [rarm]RARM_JOINT6 CHEST_JOINT1
[HrpsysSeqStateROSBridge0]   target = RARM_LINK6, sensor_name = rhsensor
[HrpsysSeqStateROSBridge0]   localPos =     [-0.0042,  0.0392,  -0.1245][m]
[HrpsysSeqStateROSBridge0] End Effector [larm]LARM_JOINT6 CHEST_JOINT1
[HrpsysSeqStateROSBridge0]   target = LARM_LINK6, sensor_name = lhsensor
[HrpsysSeqStateROSBridge0]   localPos =     [-0.0042,  -0.0392,  -0.1245][m]
[ INFO] [1491457735.624211026]: [HrpsysSeqStateROSBridge] Loaded HRP2JSKNTS
[ INFO] [1491457735.624367652]: [HrpsysSeqStateROSBridge] @Initilize name : HrpsysSeqStateROSBridge0 done
[hrpsys.py] wait for RTCmanager : None
[hrpsys.py] wait for RobotHardware0 : None ( timeout 0 < 10)
[sensor_ros_bridge_connect.py] wait for RTCmanager : valkyrie
[sensor_ros_bridge_connect.py] wait for RobotHardware0 : None ( timeout 0 < 10)
[rtmlaunch] Wait for  /localhost:15005/RobotHardware0.rtc:q   1 /30
[WARN] [WallTime: 1491457736.320193] [0.000000] Could not found CollisionDetector(co), waiting...
[hrpsys.py] wait for RobotHardware0 : None ( timeout 1 < 10)
[sensor_ros_bridge_connect.py] wait for RobotHardware0 : None ( timeout 1 < 10)
[rtmlaunch] Wait for  /localhost:15005/RobotHardware0.rtc:q   2 /30
[WARN] [WallTime: 1491457737.321900] [0.000000] Could not found CollisionDetector(co), waiting...
[hrpsys.py] wait for RobotHardware0 : None ( timeout 2 < 10)
[sensor_ros_bridge_connect.py] wait for RobotHardware0 : None ( timeout 2 < 10)
[rtmlaunch] Wait for  /localhost:15005/RobotHardware0.rtc:q   3 /30
[WARN] [WallTime: 1491457738.324213] [0.000000] Could not found CollisionDetector(co), waiting...
[hrpsys.py] wait for RobotHardware0 : None ( timeout 3 < 10)
[sensor_ros_bridge_connect.py] wait for RobotHardware0 : None ( timeout 3 < 10)
[rtmlaunch] Wait for  /localhost:15005/RobotHardware0.rtc:q   4 /30
[WARN] [WallTime: 1491457739.326570] [0.000000] Could not found CollisionDetector(co), waiting...

@iory
Copy link
Contributor

iory commented Apr 6, 2017

これ何故できないのでしょう.
hrpsyspyでwait for RobotHardwareはどういう場合に出るでしょうか?

@YoheiKakiuchi
Copy link
Member

変えてる箇所は quick - world のところだけかな?

@YoheiKakiuchi
Copy link
Member

hrp2jsknt/joint_command や hrp2jsknt/robot_state をrostopic echoすると値が出ているかな?

あと、gazeboを上げる方のlaunchでのメッセージが 変更の前後で何か変わっていないかな?

@ban-masa
Copy link
Contributor

ban-masa commented Apr 6, 2017

僕もquick->worldにすると同様の現象になりました。
ただ、そもそもgazebo_hrp2jsknts_no_controllers.launchのみを立ち上げた時点で、gazeboの時間が止まったまま進まなくなっているので、それも関係しているように思います。

@iory
Copy link
Contributor

iory commented Apr 6, 2017

変えてる箇所は quick - world のところだけかな?

はい,empty.worldのそこだけを変更しています.

roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch

を立ち上げた時に,
quickの時には
/HRP2JSKNTS/joint_command 出ない
/HRP2JSKNTS/robot_state 出る
worldの時には,
/HRP2JSKNTS/joint_command 出ない
/HRP2JSKNTS/robot_state 最初に数トピック出て以降,出ない
となっています.

@iory
Copy link
Contributor

iory commented Apr 6, 2017

あと、gazeboを上げる方のlaunchでのメッセージが 変更の前後で何か変わっていないかな?

diffをとってみましたが,時間などの違い以外は
diffがないようです.

iory@valkyrie  ~/catkin_ws/hrp2_gazebo2/src/rtm-ros-robotics |        iory@valkyrie  ~/catkin_ws/hrp2_gazebo2/src/rtm-ros-robotic
... logging to /home/iory/.ros/log/e047dc82-1aac-11e7-ad18-d0 | ... logging to /home/iory/.ros/log/e047dc82-1aac-11e7-ad18-d0
Checking log directory for disk usage. This may take awhile.    Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt                                       Press Ctrl-C to interrupt
WARNING: disk usage in log directory [/home/iory/.ros/log] is   WARNING: disk usage in log directory [/home/iory/.ros/log] is
It's recommended that you use the 'rosclean' command.           It's recommended that you use the 'rosclean' command.

started roslaunch server http://192.168.97.72:41724/          | started roslaunch server http://192.168.97.72:46840/

SUMMARY                                                         SUMMARY
========                                                        ========

PARAMETERS                                                      PARAMETERS
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso    * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_senso
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors: ['imu    * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors: ['imu
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config    * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config    * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config    * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/iob_rate: 250         * /HRP2JSKNTS/hrpsys_gazebo_configuration/iob_rate: 250
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/joint_id_list: [0,    * /HRP2JSKNTS/hrpsys_gazebo_configuration/joint_id_list: [0,
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/joints: ['RLEG_JOI    * /HRP2JSKNTS/hrpsys_gazebo_configuration/joints: ['RLEG_JOI
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/robotname: HRP2JSK    * /HRP2JSKNTS/hrpsys_gazebo_configuration/robotname: HRP2JSK
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_joint_effort:     * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_joint_effort: 
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_synchronized_c    * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_synchronized_c
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_velocity_feedb    * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_velocity_feedb
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/    * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
 * /HRP3HAND_L/hrpsys_gazebo_configuration/joint_id_list: [0,    * /HRP3HAND_L/hrpsys_gazebo_configuration/joint_id_list: [0,
 * /HRP3HAND_L/hrpsys_gazebo_configuration/joints: ['L_THUMBC    * /HRP3HAND_L/hrpsys_gazebo_configuration/joints: ['L_THUMBC
 * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_stat    * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_stat
 * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_stat    * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_stat
 * /HRP3HAND_L/hrpsys_gazebo_configuration/robotname: HRP3HAN    * /HRP3HAND_L/hrpsys_gazebo_configuration/robotname: HRP3HAN
 * /HRP3HAND_L/hrpsys_gazebo_configuration/use_loose_synchron    * /HRP3HAND_L/hrpsys_gazebo_configuration/use_loose_synchron
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/    * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
 * /HRP3HAND_R/hrpsys_gazebo_configuration/joint_id_list: [0,    * /HRP3HAND_R/hrpsys_gazebo_configuration/joint_id_list: [0,
 * /HRP3HAND_R/hrpsys_gazebo_configuration/joints: ['R_THUMBC    * /HRP3HAND_R/hrpsys_gazebo_configuration/joints: ['R_THUMBC
 * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_stat    * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_stat
 * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_stat    * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_stat
 * /HRP3HAND_R/hrpsys_gazebo_configuration/robotname: HRP3HAN    * /HRP3HAND_R/hrpsys_gazebo_configuration/robotname: HRP3HAN
 * /HRP3HAND_R/hrpsys_gazebo_configuration/use_loose_synchron    * /HRP3HAND_R/hrpsys_gazebo_configuration/use_loose_synchron
 * /robot_description: <?xml version="1....                      * /robot_description: <?xml version="1....
 * /rosdistro: indigo                                            * /rosdistro: indigo
 * /rosversion: 1.11.20                                          * /rosversion: 1.11.20
 * /use_sim_time: True                                           * /use_sim_time: True

NODES                                                           NODES
  /                                                               /
    gazebo (hrpsys_gazebo_general/gazebo)                           gazebo (hrpsys_gazebo_general/gazebo)
    robot_state_publisher (robot_state_publisher/state_publis       robot_state_publisher (robot_state_publisher/state_publis
    spawn_robot_model (gazebo_ros/spawn_model)                      spawn_robot_model (gazebo_ros/spawn_model)

ROS_MASTER_URI=http://localhost:11311                           ROS_MASTER_URI=http://localhost:11311

core service [/rosout] found                                    core service [/rosout] found
process[gazebo-1]: started with pid [18790]                   | process[gazebo-1]: started with pid [22357]
process[robot_state_publisher-2]: started with pid [18792]    | process[robot_state_publisher-2]: started with pid [22359]
process[spawn_robot_model-3]: started with pid [18793]        | process[spawn_robot_model-3]: started with pid [22360]
Gazebo multi-robot simulator, version 2.2.3                     Gazebo multi-robot simulator, version 2.2.3
Copyright (C) 2012-2014 Open Source Robotics Foundation.        Copyright (C) 2012-2014 Open Source Robotics Foundation.
Released under the Apache 2 License.                            Released under the Apache 2 License.
http://gazebosim.org                                            http://gazebosim.org

Gazebo multi-robot simulator, version 2.2.3                     Gazebo multi-robot simulator, version 2.2.3
Copyright (C) 2012-2014 Open Source Robotics Foundation.        Copyright (C) 2012-2014 Open Source Robotics Foundation.
Released under the Apache 2 License.                            Released under the Apache 2 License.
http://gazebosim.org                                            http://gazebosim.org

Msg Waiting for master.[ INFO] [1491507173.358604042]: Finish | Msg Waiting for master.[ INFO] [1491507249.680046435]: Finish
[ INFO] [1491507173.359154452]: waitForService: Service [/gaz | [ INFO] [1491507249.680657816]: waitForService: Service [/gaz
Msg Waiting for master                                          Msg Waiting for master
Msg Connected to gazebo master @ http://127.0.0.1:11345         Msg Connected to gazebo master @ http://127.0.0.1:11345
Msg Publicized address: 192.168.97.72                           Msg Publicized address: 192.168.97.72
[ INFO] [1491507174.117284351, 0.022000000]: waitForService:  | [ INFO] [1491507250.426203107, 0.023000000]: waitForService: 
[ INFO] [1491507174.138285167, 0.042000000]: Physics dynamic  | [ INFO] [1491507250.447325788, 0.044000000]: Physics dynamic 

Msg Connected to gazebo master @ http://127.0.0.1:11345         Msg Connected to gazebo master @ http://127.0.0.1:11345
Msg Publicized address: 192.168.97.72                           Msg Publicized address: 192.168.97.72
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
Warning [parser_urdf.cc:1303] Note that cfmDamping is being d   Warning [parser_urdf.cc:1303] Note that cfmDamping is being d
[ INFO] [1491507174.830580621, 0.364000000]: Camera Plugin (r | [ INFO] [1491507251.089105294, 0.371000000]: Camera Plugin (r
[ INFO] [1491507174.835471734, 0.364000000]: Camera Plugin (n | [ INFO] [1491507251.093507763, 0.371000000]: Camera Plugin (n
[ WARN] [1491507174.835525251, 0.364000000]: dynamic reconfig | [ WARN] [1491507251.093555126, 0.371000000]: dynamic reconfig
[spawn_robot_model-3] process has finished cleanly              [spawn_robot_model-3] process has finished cleanly
log file: /home/iory/.ros/log/e047dc82-1aac-11e7-ad18-d050996   log file: /home/iory/.ros/log/e047dc82-1aac-11e7-ad18-d050996
[ WARN] [1491507175.414868133, 0.364000000]: USE ROBOT NAME f | [ WARN] [1491507251.607556797, 0.371000000]: USE ROBOT NAME f
[ INFO] [1491507175.417947662, 0.364000000]: loose synchroniz | [ INFO] [1491507251.610606382, 0.371000000]: loose synchroniz
[ WARN] [1491507175.418847784, 0.364000000]: override use_veo | [ WARN] [1491507251.612046965, 0.371000000]: override use_veo
[ INFO] [1491507175.419537494, 0.364000000]: use_joint_effort | [ INFO] [1491507251.613111001, 0.371000000]: use_joint_effort
[ INFO] [1491507175.421329157, 0.364000000]: iob rate 250.000 | [ INFO] [1491507251.614075623, 0.371000000]: iob rate 250.000
[ INFO] [1491507175.424218819, 0.364000000]: robotname: HRP2J | [ INFO] [1491507251.618009302, 0.371000000]: robotname: HRP2J
[ INFO] [1491507175.424363314, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618178535, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424399296, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618257671, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424423153, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618300403, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424445892, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618329788, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424464917, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618358940, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424492017, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618387246, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424514478, 0.364000000]: add joint: RLEG_ | [ INFO] [1491507251.618410226, 0.371000000]: add joint: RLEG_
[ INFO] [1491507175.424532838, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618436922, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424551323, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618462770, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424568781, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618482108, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424585734, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618504580, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424607459, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618532462, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424649179, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618588291, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424692000, 0.364000000]: add joint: LLEG_ | [ INFO] [1491507251.618616679, 0.371000000]: add joint: LLEG_
[ INFO] [1491507175.424713278, 0.364000000]: add joint: CHEST | [ INFO] [1491507251.618639592, 0.371000000]: add joint: CHEST
[ INFO] [1491507175.424731728, 0.364000000]: add joint: CHEST | [ INFO] [1491507251.618666190, 0.371000000]: add joint: CHEST
[ INFO] [1491507175.424763724, 0.364000000]: add joint: HEAD_ | [ INFO] [1491507251.618694178, 0.371000000]: add joint: HEAD_
[ INFO] [1491507175.424786681, 0.364000000]: add joint: HEAD_ | [ INFO] [1491507251.618721574, 0.371000000]: add joint: HEAD_
[ INFO] [1491507175.424804577, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618747396, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424825538, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618766682, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424846866, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618789892, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424866688, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618817135, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424886968, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618840948, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424908395, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618866908, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424926784, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618886757, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424950929, 0.364000000]: add joint: RARM_ | [ INFO] [1491507251.618910887, 0.371000000]: add joint: RARM_
[ INFO] [1491507175.424979616, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.618936188, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425001081, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.618957481, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425022057, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.618982429, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425043003, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.619006353, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425062729, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.619034920, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425098367, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.619064328, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425124669, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.619080929, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425148311, 0.364000000]: add joint: LARM_ | [ INFO] [1491507251.619104576, 0.371000000]: add joint: LARM_
[ INFO] [1491507175.425167261, 0.364000000]: add joint: L_THU | [ INFO] [1491507251.619132467, 0.371000000]: add joint: L_THU
[ INFO] [1491507175.425188025, 0.364000000]: add joint: L_THU | [ INFO] [1491507251.619161193, 0.371000000]: add joint: L_THU
[ INFO] [1491507175.425208463, 0.364000000]: add joint: L_IND | [ INFO] [1491507251.619187459, 0.371000000]: add joint: L_IND
[ INFO] [1491507175.425229079, 0.364000000]: add joint: L_IND | [ INFO] [1491507251.619206223, 0.371000000]: add joint: L_IND
[ INFO] [1491507175.425247353, 0.364000000]: add joint: L_IND | [ INFO] [1491507251.619230757, 0.371000000]: add joint: L_IND
[ INFO] [1491507175.425267842, 0.364000000]: add joint: L_MID | [ INFO] [1491507251.619259298, 0.371000000]: add joint: L_MID
[ INFO] [1491507175.425300150, 0.364000000]: add joint: R_THU | [ INFO] [1491507251.619286820, 0.371000000]: add joint: R_THU
[ INFO] [1491507175.425325057, 0.364000000]: add joint: R_THU | [ INFO] [1491507251.619312344, 0.371000000]: add joint: R_THU
[ INFO] [1491507175.425345599, 0.364000000]: add joint: R_IND | [ INFO] [1491507251.619333552, 0.371000000]: add joint: R_IND
[ INFO] [1491507175.425365875, 0.364000000]: add joint: R_IND | [ INFO] [1491507251.619356400, 0.371000000]: add joint: R_IND
[ INFO] [1491507175.425386657, 0.364000000]: add joint: R_IND | [ INFO] [1491507251.619382761, 0.371000000]: add joint: R_IND
[ INFO] [1491507175.425404784, 0.364000000]: add joint: R_MID | [ INFO] [1491507251.619403504, 0.371000000]: add joint: R_MID
[ INFO] [1491507175.425430854, 0.364000000]: force: lfsensor, | [ INFO] [1491507251.619440944, 0.371000000]: force: lfsensor,
[ INFO] [1491507175.425591081, 0.364000000]: force: lhsensor, | [ INFO] [1491507251.619791416, 0.371000000]: force: lhsensor,
[ INFO] [1491507175.425630524, 0.364000000]: force: rfsensor, | [ INFO] [1491507251.619839952, 0.371000000]: force: rfsensor,
[ INFO] [1491507175.425669197, 0.364000000]: force: rhsensor, | [ INFO] [1491507251.619890772, 0.371000000]: force: rhsensor,
[ INFO] [1491507175.425705450, 0.364000000]: imu: imu_sensor0 | [ INFO] [1491507251.619942385, 0.371000000]: imu: imu_sensor0
[ INFO] [1491507175.425870505, 0.364000000]: joints size = 46 | [ INFO] [1491507251.620199138, 0.371000000]: joints size = 46
[ INFO] [1491507175.426063577, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620519065, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426096561, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620554545, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426122872, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620589306, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426148664, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620623061, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426173692, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620666516, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426196935, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620699343, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426221259, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620733291, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426246389, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620767202, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426271188, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620800478, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426293546, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620838319, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426315701, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620871614, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426336837, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620906159, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426356878, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620939596, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426377432, 0.364000000]: Bounds for joint | [ INFO] [1491507251.620973277, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426401319, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621005874, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426424663, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621037682, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426447364, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621072133, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426469460, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621102917, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426491118, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621134589, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426513727, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621166605, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426535692, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621200135, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426557005, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621233065, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426578902, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621264269, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426600113, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621295602, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426621977, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621327332, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426643827, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621360210, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426665604, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621390845, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426687632, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621425469, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426709581, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621458023, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426732691, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621488391, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426754037, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621518156, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426795215, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621552336, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426822089, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621583923, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426843948, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621618058, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426934263, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621652574, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426963632, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621687737, 0.371000000]: Bounds for joint
[ INFO] [1491507175.426987140, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621717597, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427010291, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621745860, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427032860, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621775015, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427055344, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621807370, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427077582, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621838228, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427098939, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621875304, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427120867, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621906087, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427141833, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621941607, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427162519, 0.364000000]: Bounds for joint | [ INFO] [1491507251.621971446, 0.371000000]: Bounds for joint
[ INFO] [1491507175.427183873, 0.364000000]: Bounds for joint | [ INFO] [1491507251.622002903, 0.371000000]: Bounds for joint
[ WARN] [1491507175.428366897, 0.364000000]: IOBPlugin: could | [ WARN] [1491507251.624408426, 0.371000000]: IOBPlugin: could
[ WARN] [1491507175.429699245, 0.365000000]: IOBPlugin: could | [ WARN] [1491507251.627602589, 0.372000000]: IOBPlugin: could
[ WARN] [1491507175.430985608, 0.366000000]: IOBPlugin: could | [ WARN] [1491507251.630998628, 0.374000000]: IOBPlugin: could
[ WARN] [1491507175.432857271, 0.368000000]: IOBPlugin: could | [ WARN] [1491507251.634190853, 0.376000000]: IOBPlugin: could
[ WARN] [1491507175.435432961, 0.370000000]: IOBPlugin: could | [ WARN] [1491507251.639942672, 0.379000000]: IOBPlugin: could
[ WARN] [1491507175.437635332, 0.372000000]: IOBPlugin: could | [ WARN] [1491507251.642403562, 0.380000000]: IOBPlugin: could
[ WARN] [1491507175.439478474, 0.374000000]: IOBPlugin: could | [ WARN] [1491507251.648790923, 0.383000000]: IOBPlugin: could
Msg SetVelPlugin was loaded !                                   Msg SetVelPlugin was loaded !
[ WARN] [1491507175.440893724, 0.376000000]: IOBPlugin: could | [ WARN] [1491507251.658197734, 0.391000000]: IOBPlugin: could
[ WARN] [1491507175.441618827, 0.376000000]: IOBPlugin: could | [ WARN] [1491507251.659614964, 0.391000000]: IOBPlugin: could
[ WARN] [1491507175.442399538, 0.376000000]: IOBPlugin: could | [ WARN] [1491507251.662113415, 0.393000000]: IOBPlugin: could
[ WARN] [1491507175.443300262, 0.378000000]: IOBPlugin: could | [ WARN] [1491507251.663249629, 0.395000000]: IOBPlugin: could
[ WARN] [1491507175.444159865, 0.379000000]: IOBPlugin: could | [ WARN] [1491507251.663976799, 0.395000000]: IOBPlugin: could
[ WARN] [1491507175.445003224, 0.379000000]: IOBPlugin: could | [ WARN] [1491507251.664735533, 0.396000000]: IOBPlugin: could
[ WARN] [1491507175.445833434, 0.381000000]: IOBPlugin: could | [ WARN] [1491507251.665599172, 0.397000000]: IOBPlugin: could
[ WARN] [1491507175.446537497, 0.381000000]: IOBPlugin: could | [ WARN] [1491507251.666347793, 0.398000000]: IOBPlugin: could
[ WARN] [1491507175.447318605, 0.382000000]: IOBPlugin: could | [ WARN] [1491507251.667152915, 0.398000000]: IOBPlugin: could
[ WARN] [1491507175.448110135, 0.383000000]: IOBPlugin: could | [ WARN] [1491507251.667897187, 0.399000000]: IOBPlugin: could
[ WARN] [1491507175.448869371, 0.383000000]: IOBPlugin: could | [ WARN] [1491507251.668645905, 0.400000000]: IOBPlugin: could
[ WARN] [1491507175.449658615, 0.384000000]: IOBPlugin: could | [ WARN] [1491507251.669482348, 0.401000000]: IOBPlugin: could
[ WARN] [1491507175.450464344, 0.385000000]: IOBPlugin: could | [ WARN] [1491507251.670234071, 0.401000000]: IOBPlugin: could
[ WARN] [1491507175.451179012, 0.385000000]: IOBPlugin: could | [ WARN] [1491507251.671174963, 0.402000000]: IOBPlugin: could
[ WARN] [1491507175.451948828, 0.386000000]: IOBPlugin: could | [ WARN] [1491507251.671992046, 0.403000000]: IOBPlugin: could
[ WARN] [1491507175.453012962, 0.387000000]: IOBPlugin: could | [ WARN] [1491507251.672842093, 0.404000000]: IOBPlugin: could
[ WARN] [1491507175.454028351, 0.388000000]: IOBPlugin: could | [ WARN] [1491507251.673651545, 0.405000000]: IOBPlugin: could
[ WARN] [1491507175.455005039, 0.389000000]: IOBPlugin: could | [ WARN] [1491507251.674410851, 0.406000000]: IOBPlugin: could
[ WARN] [1491507175.455462727, 0.390000000]: IOBPlugin: could | [ WARN] [1491507251.674813856, 0.406000000]: IOBPlugin: could
[ WARN] [1491507175.455882929, 0.390000000]: IOBPlugin: could | [ WARN] [1491507251.675229328, 0.406000000]: IOBPlugin: could
[ WARN] [1491507175.456741585, 0.391000000]: IOBPlugin: could | [ WARN] [1491507251.676029603, 0.407000000]: IOBPlugin: could
[ WARN] [1491507175.457696663, 0.392000000]: IOBPlugin: could | [ WARN] [1491507251.676777681, 0.407000000]: IOBPlugin: could
[ WARN] [1491507175.461096977, 0.395000000]: IOBPlugin: could | [ WARN] [1491507251.677509702, 0.408000000]: IOBPlugin: could
[ WARN] [1491507175.462164670, 0.396000000]: IOBPlugin: could | [ WARN] [1491507251.678227611, 0.408000000]: IOBPlugin: could
[ WARN] [1491507175.464758175, 0.398000000]: IOBPlugin: could | [ WARN] [1491507251.679128258, 0.409000000]: IOBPlugin: could
[ WARN] [1491507175.467358694, 0.399000000]: IOBPlugin: could | [ WARN] [1491507251.679959944, 0.410000000]: IOBPlugin: could
[ WARN] [1491507175.468680027, 0.401000000]: IOBPlugin: could | [ WARN] [1491507251.680871206, 0.411000000]: IOBPlugin: could
[ WARN] [1491507175.469124477, 0.401000000]: IOBPlugin: could | [ WARN] [1491507251.681250353, 0.411000000]: IOBPlugin: could
[ WARN] [1491507175.469666413, 0.402000000]: IOBPlugin: could | [ WARN] [1491507251.681672647, 0.412000000]: IOBPlugin: could
[ WARN] [1491507175.470691689, 0.403000000]: IOBPlugin: could | [ WARN] [1491507251.682433479, 0.412000000]: IOBPlugin: could
[ WARN] [1491507175.471730325, 0.404000000]: IOBPlugin: could | [ WARN] [1491507251.683275787, 0.413000000]: IOBPlugin: could
[ WARN] [1491507175.472564308, 0.405000000]: IOBPlugin: could | [ WARN] [1491507251.684115191, 0.414000000]: IOBPlugin: could
[ WARN] [1491507175.473375852, 0.405000000]: IOBPlugin: could | [ WARN] [1491507251.684913148, 0.415000000]: IOBPlugin: could
[ WARN] [1491507175.474625779, 0.407000000]: IOBPlugin: could | [ WARN] [1491507251.685713535, 0.416000000]: IOBPlugin: could
[ WARN] [1491507175.475886215, 0.408000000]: IOBPlugin: could | [ WARN] [1491507251.687832144, 0.418000000]: IOBPlugin: could
[ WARN] [1491507175.477107060, 0.409000000]: IOBPlugin: could | [ WARN] [1491507251.688755630, 0.419000000]: IOBPlugin: could
[ WARN] [1491507175.478350106, 0.411000000]: IOBPlugin: could | [ WARN] [1491507251.689438025, 0.419000000]: IOBPlugin: could
[ WARN] [1491507175.480678278, 0.413000000]: IOBPlugin: could | [ WARN] [1491507251.690123008, 0.420000000]: IOBPlugin: could
[ WARN] [1491507175.481678304, 0.414000000]: IOBPlugin: could | [ WARN] [1491507251.690879403, 0.421000000]: IOBPlugin: could
[ WARN] [1491507175.482731722, 0.415000000]: IOBPlugin: could | [ WARN] [1491507251.691576373, 0.421000000]: IOBPlugin: could
[ WARN] [1491507175.483617310, 0.416000000]: IOBPlugin: could | [ WARN] [1491507251.692321446, 0.422000000]: IOBPlugin: could

@YoheiKakiuchi
Copy link
Member

@ban-masa の説明と、topicが止まっているとのことで、gazeboの時間が進んでいないのが原因かと思います。
gazeboがrostimeを出していて、gazeboのiobではそれを使ってるのでhrpsysが止まるのだと思います。
(gazeboが止まっているのでhrpsysが立ち上がってもあまり意味がないです)
なので、gazeboが止まる原因を追ってみましょう。

  • empty.worldだけでgazeboの時間が進むか試してみる

hrpsys_gazebo_general/launch/gazebo_robot_no_controllers.launchで
SPAWN_MODELをfalseにするとロボットがでないと思う

  • odeの他のパラメータも変更してみる

@snozawa の貼ってくれているパラメータと quick,world以外に違うところがある。
cfm や erp が違うのでこれを変更すると変わるかどうか。

  • IOBPluginを抜いてみる

hrpsys_gazebo_tutorials/robot_models/HRP2JSKNT/HRP2JSKNT.urdf.xacro
のlibIOBPlugin.soをロードしている部分を抜いてみる
それでも動かないようなら、そのxacroの記述を最初の HRP2JSKNT_WH_SENSORS.urdf の
インクルードだけにしてみる。
いずれも、hrpsysは動かないし、ロボットは崩れ落ちると思うけれども、gazeboの時間が
進むかどうか

@iory
Copy link
Contributor

iory commented Apr 7, 2017

empty.worldだけでgazeboの時間が進むか試してみる

quick -> worldにした状態で,立ち上げたところ,時間が進んでいるので,ここまでは大丈夫そうです.
empty.worldで時間が進むのを確認した上で,
SPAWN_MODELをtrueにすると,
時間が0.0234まで進んで止まっているので,
最初少しは時間が進むようです.一瞬joint_statesが出るのもわかりました.

odeの他のパラメータも変更してみる

もともとcfmは0.0, erpは0.2でやっていましたが,
@snozawa さんの1e-7, 1e-2に変えたり,大きくしてみましたが変わりませんでした.

IOBPluginを抜いてみる

IOBを抜くと,HRP2が以下のようになりますが,時間が進みます.
without-libiobplugin

@YoheiKakiuchi
Copy link
Member

IOBPluginに何か問題があるように思う。

rtmros_tutorials/hrpsys_gazebo_tutorials/config/HRP2JSKNT.yaml の中の
use_velocity_feedback: true
use_joint_effort: true
をそれぞれ、falseにしてみてどうなるか試してみて欲しい。

これで上手く行かないようなら、IOBPluginにデバッグメッセージを仕込んでどこで止まっているか突き止めて、対応するしかないかな。

@iory
Copy link
Contributor

iory commented Apr 7, 2017

rtmros_tutorials/hrpsys_gazebo_tutorials/config/HRP2JSKNT.yaml の中の
use_velocity_feedback: true
use_joint_effort: true
をそれぞれ、falseにしてみてどうなるか試してみて欲しい。

これも時間が止まりますね.

IOBPluginのデバッグを進めてみます.

@iory
Copy link
Contributor

iory commented Apr 7, 2017

rosのclockが途中ででなくなることが問題なので,
iobpluginが直接悪くないような気がします.

@iory
Copy link
Contributor

iory commented Apr 11, 2017

HRP2JSKNTS.urdf.xacroを

<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="HRP2JSKNTS" >
  <xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/HRP2JSKNTS_WH_SENSORS.urdf" />
  <!-- <xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/SampleRobot.urdf" /> -->
  <!-- add IOB plugin -->
</robot>

というふうにしてやるとclockが進まないで,モデル自体も表示されないのですが,以下のようにsamplerobotに変更するとモデルが出て,clockも進みます.

<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="HRP2JSKNTS" >
  <!-- <xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/HRP2JSKNTS_WH_SENSORS.urdf" /> -->
  <xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/SampleRobot.urdf" />
  <!-- add IOB plugin -->
</robot>

screenshot 2017-04-11 17 01 01

@iory
Copy link
Contributor

iory commented Apr 11, 2017

includeの部分で,
<xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/HRP2JSKNTS_WH_SENSORS.urdf" /> の代わりに,WH_sensorsを抜いて
<xacro:include filename="$(find hrpsys_ros_bridge_tutorials)/models/HRP2JSKNTS.urdf" />
でやると起動出来ます.
screenshot 2017-04-11 17 07 49

@iory
Copy link
Contributor

iory commented Apr 11, 2017

valkyrieがindigoでgazebo4を使っているようなので,
gazebo4をインストールしてみてworldでできるかを試してみました.
worldで実行できましたが,やはりSTをOnにすると倒れてしまいました.
https://drive.google.com/file/d/0B_NiLAzvehC9MzRLOGhRUi01eUE/view?usp=sharing

やはりbush_customizerなどを入れる必要があるのかと思います.

@robograffitti
Copy link
Member

valkyrieはindigo+gazebo7です(srcsim パッケージの話)
https://bitbucket.org/osrf/srcsim/wiki/system_setup

この環境を使って実験してますが、かなりちゃんと歩きますね。

また、余談ですが、apt-get install の drcsimにも複数個バージョンがあって、
drcsim5 や drcsim7 のように各gazeboのバージョンに対応したパッケージが存在しています。

ちなみに、ROS DISTROごとの対応付けは、
indigo -> gazebo2
jade -> gazebo5
kinetic -> gazebo7
になってます。
http://gazebosim.org/tutorials?tut=ros_wrapper_versions

こういう感じなので、gazebo7も視野に入れて問題の解決を考えた方がいい気もしますが、
gazebo7までいってしまうと、C++11でコンパイルする必要があり、
boostからSTLに取り込まれた機能に合わせて色々な箇所を書き換える必要が出てきて結構大変そうです。
(一度、gazebo7でrtmros_gazeboをコンパイルしようとしましたが、挫折しました)

@iory
Copy link
Contributor

iory commented Apr 11, 2017

@yoshimalucky さん
ありがとうございます.

いずれはkineticでgazebo7になるということで試してみます.

@iory
Copy link
Contributor

iory commented Apr 12, 2017

gazebo7でvalkyrieが動くまでを確認し,
rtmros_gazeboをc++11でコンパイルできるようにして
iory/rtmros_gazebo@be012bd

roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch

によってgazeboを立ち上げると,
初期状態から回転してしまいます.
何か解決方法はあるでしょうか.
https://drive.google.com/file/d/0B_NiLAzvehC9RFl2UlN5a1Y3Zzg/view?usp=sharing
立ち上げた時のlogは以下です.

 leus@leus-ThinkPad-W541  ~/catkin_ws/hrp2_gazebo/src/rtm-ros-robotics/rtmros_gazebo/hrpsys_gazebo_general   kinetic-devel ●  roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch
... logging to /home/leus/.ros/log/f8bf374a-1f68-11e7-aa6f-54ee75499bfb/roslaunch-leus-ThinkPad-W541-2726.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://133.11.216.86:37380/

SUMMARY
========

PARAMETERS
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors: ['rfsensor', 'lfs...
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lfsensor/frame_id: LLEG_LINK5
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lfsensor/joint_name: LLEG_JOINT5
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lfsensor/rotation: [1, 0, 0, 0]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lfsensor/translation: [0, 0, -0.105]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lhsensor/frame_id: LARM_LINK6
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lhsensor/joint_name: LARM_JOINT6
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lhsensor/rotation: [1, 0, 0, 0]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/lhsensor/translation: [0, 0, -0.0775]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rfsensor/frame_id: RLEG_LINK5
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rfsensor/joint_name: RLEG_JOINT5
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rfsensor/rotation: [1, 0, 0, 0]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rfsensor/translation: [0, 0, -0.105]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rhsensor/frame_id: RARM_LINK6
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rhsensor/joint_name: RARM_JOINT6
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rhsensor/rotation: [1, 0, 0, 0]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/force_torque_sensors_config/rhsensor/translation: [0, 0, -0.0775]
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/p_v: 325.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/p_v: 450.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/i_clamp: 0.0
* /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/p_v: 150.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/p_v: 325.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/p_v: 450.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/p_v: 350.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/d: 0.075
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/p: 700.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/p_v: 250.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/d: 0.01
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/i: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/i_clamp: 0.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/p: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/p_v: 10.0
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors: ['imu_sensor0']
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config/imu_sensor0/frame_id: CHEST_LINK1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config/imu_sensor0/link_name: CHEST_LINK1
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/imu_sensors_config/imu_sensor0/ros_name: waist_imu
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/iob_rate: 250
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/joint_id_list: [0, 1, 2, 3, 4, 5...
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/joints: ['RLEG_JOINT0', '...
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/robotname: HRP2JSKNTS
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_joint_effort: True
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_synchronized_command: False
 * /HRP2JSKNTS/hrpsys_gazebo_configuration/use_velocity_feedback: True
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/d: 0.01
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/i: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/i_clamp: 0.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/p: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/p_v: 10.0
 * /HRP3HAND_L/hrpsys_gazebo_configuration/joint_id_list: [0, 1, 2, 3, 4, 5]
 * /HRP3HAND_L/hrpsys_gazebo_configuration/joints: ['L_THUMBCM_Y', '...
 * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_state/step: 25
 * /HRP3HAND_L/hrpsys_gazebo_configuration/publish_joint_state/topic: /joint_states
 * /HRP3HAND_L/hrpsys_gazebo_configuration/robotname: HRP3HAND_L
 * /HRP3HAND_L/hrpsys_gazebo_configuration/use_loose_synchronized: False
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/d: 0.01
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/i: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/i_clamp: 0.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/p: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/p_v: 10.0
 * /HRP3HAND_R/hrpsys_gazebo_configuration/joint_id_list: [0, 1, 2, 3, 4, 5]
 * /HRP3HAND_R/hrpsys_gazebo_configuration/joints: ['R_THUMBCM_Y', '...
 * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_state/step: 25
 * /HRP3HAND_R/hrpsys_gazebo_configuration/publish_joint_state/topic: /joint_states
 * /HRP3HAND_R/hrpsys_gazebo_configuration/robotname: HRP3HAND_R
 * /HRP3HAND_R/hrpsys_gazebo_configuration/use_loose_synchronized: False
 * /robot_description: <?xml version="1....
 * /rosdistro: indigo
 * /rosversion: 1.11.21
 * /use_sim_time: True

NODES
  /
    gazebo (hrpsys_gazebo_general/gazebo)
    robot_state_publisher (robot_state_publisher/state_publisher)
    spawn_robot_model (gazebo_ros/spawn_model)

auto-starting new master
process[master]: started with pid [2743]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to f8bf374a-1f68-11e7-aa6f-54ee75499bfb
process[rosout-1]: started with pid [2760]
started core service [/rosout]
process[gazebo-2]: started with pid [2784]
process[robot_state_publisher-3]: started with pid [2786]
process[spawn_robot_model-4]: started with pid [2787]
[ INFO] [1491992140.458313546]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1491992140.458754330]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting...
[ INFO] [1491992140.836921502, 0.022000000]: waitForService: Service [/gazebo/set_physics_properties] is now available.
[ INFO] [1491992140.861406185, 0.046000000]: Physics dynamic reconfigure ready.
[ INFO] [1491992141.407425096, 0.164000000]: Camera Plugin (robotNamespace = /), Info: Using the 'robotNamespace' param: '/'
[ INFO] [1491992141.411203092, 0.164000000]: Camera Plugin (ns = /)  <tf_prefix_>, set to ""
[ WARN] [1491992141.411241287, 0.164000000]: dynamic reconfigure is not enabled for this image topic [xtion/rgb/image_raw] becuase <cameraName> is not specified
[spawn_robot_model-4] process has finished cleanly
log file: /home/leus/.ros/log/f8bf374a-1f68-11e7-aa6f-54ee75499bfb/spawn_robot_model-4*.log
[ WARN] [1491992141.652239814, 0.164000000]: USE ROBOT NAME from URDF: HRP2JSKNTS, scoped name(HRP2JSKNTS)
[ INFO] [1491992141.654970820, 0.164000000]: loose synchronized 1
[ WARN] [1491992141.656043120, 0.164000000]: override use_veolcity_feedback at 0 by 1
[ INFO] [1491992141.657109154, 0.164000000]: use_joint_effort 1
[ INFO] [1491992141.658292059, 0.164000000]: iob rate 250.000000
[ INFO] [1491992141.662727701, 0.164000000]: robotname: HRP2JSKNTS
[ INFO] [1491992141.662850739, 0.164000000]: add joint: RLEG_JOINT0
[ INFO] [1491992141.662905639, 0.164000000]: add joint: RLEG_JOINT1
[ INFO] [1491992141.662936273, 0.164000000]: add joint: RLEG_JOINT2
[ INFO] [1491992141.662968257, 0.164000000]: add joint: RLEG_JOINT3
[ INFO] [1491992141.662996203, 0.164000000]: add joint: RLEG_JOINT4
[ INFO] [1491992141.663026825, 0.164000000]: add joint: RLEG_JOINT5
[ INFO] [1491992141.663052177, 0.164000000]: add joint: RLEG_JOINT6
[ INFO] [1491992141.663077638, 0.164000000]: add joint: LLEG_JOINT0
[ INFO] [1491992141.663102575, 0.164000000]: add joint: LLEG_JOINT1
[ INFO] [1491992141.663127521, 0.164000000]: add joint: LLEG_JOINT2
[ INFO] [1491992141.663149634, 0.164000000]: add joint: LLEG_JOINT3
[ INFO] [1491992141.663173940, 0.164000000]: add joint: LLEG_JOINT4
[ INFO] [1491992141.663200611, 0.164000000]: add joint: LLEG_JOINT5
[ INFO] [1491992141.663227017, 0.164000000]: add joint: LLEG_JOINT6
[ INFO] [1491992141.663255798, 0.164000000]: add joint: CHEST_JOINT0
[ INFO] [1491992141.663283690, 0.164000000]: add joint: CHEST_JOINT1
[ INFO] [1491992141.663308128, 0.164000000]: add joint: HEAD_JOINT0
[ INFO] [1491992141.663338456, 0.164000000]: add joint: HEAD_JOINT1
[ INFO] [1491992141.663364704, 0.164000000]: add joint: RARM_JOINT0
[ INFO] [1491992141.663387624, 0.164000000]: add joint: RARM_JOINT1
[ INFO] [1491992141.663410710, 0.164000000]: add joint: RARM_JOINT2
[ INFO] [1491992141.663437464, 0.164000000]: add joint: RARM_JOINT3
[ INFO] [1491992141.663466852, 0.164000000]: add joint: RARM_JOINT4
[ INFO] [1491992141.663495625, 0.164000000]: add joint: RARM_JOINT5
[ INFO] [1491992141.663531358, 0.164000000]: add joint: RARM_JOINT6
[ INFO] [1491992141.663559109, 0.164000000]: add joint: RARM_JOINT7
[ INFO] [1491992141.663586097, 0.164000000]: add joint: LARM_JOINT0
[ INFO] [1491992141.663610426, 0.164000000]: add joint: LARM_JOINT1
[ INFO] [1491992141.663637016, 0.164000000]: add joint: LARM_JOINT2
[ INFO] [1491992141.663664043, 0.164000000]: add joint: LARM_JOINT3
[ INFO] [1491992141.663698787, 0.164000000]: add joint: LARM_JOINT4
[ INFO] [1491992141.663731978, 0.164000000]: add joint: LARM_JOINT5
[ INFO] [1491992141.663759607, 0.164000000]: add joint: LARM_JOINT6
[ INFO] [1491992141.663795894, 0.164000000]: add joint: LARM_JOINT7
[ INFO] [1491992141.663824727, 0.164000000]: add joint: L_THUMBCM_Y
[ INFO] [1491992141.663851703, 0.164000000]: add joint: L_THUMBCM_P
[ INFO] [1491992141.663888180, 0.164000000]: add joint: L_INDEXMP_R
[ INFO] [1491992141.663919576, 0.164000000]: add joint: L_INDEXMP_P
[ INFO] [1491992141.663951878, 0.164000000]: add joint: L_INDEXPIP_R
[ INFO] [1491992141.663980677, 0.164000000]: add joint: L_MIDDLEPIP_R
[ INFO] [1491992141.664002938, 0.164000000]: add joint: R_THUMBCM_Y
[ INFO] [1491992141.664025975, 0.164000000]: add joint: R_THUMBCM_P
[ INFO] [1491992141.664048929, 0.164000000]: add joint: R_INDEXMP_R
[ INFO] [1491992141.664071432, 0.164000000]: add joint: R_INDEXMP_P
[ INFO] [1491992141.664103671, 0.164000000]: add joint: R_INDEXPIP_R
[ INFO] [1491992141.664132116, 0.164000000]: add joint: R_MIDDLEPIP_R
[ INFO] [1491992141.664169348, 0.164000000]: force: lfsensor, LLEG_JOINT5 LLEG_LINK5
[ INFO] [1491992141.664626998, 0.164000000]: force: lhsensor, LARM_JOINT6 LARM_LINK6
[ INFO] [1491992141.664670217, 0.164000000]: force: rfsensor, RLEG_JOINT5 RLEG_LINK5
[ INFO] [1491992141.664710091, 0.164000000]: force: rhsensor, RARM_JOINT6 RARM_LINK6
[ INFO] [1491992141.664742377, 0.164000000]: imu: imu_sensor0, waist_imu, CHEST_LINK1, CHEST_LINK1
[ INFO] [1491992141.665031943, 0.164000000]: joints size = 46
[ INFO] [1491992141.665309504, 0.164000000]: Bounds for joint[RLEG_JOINT0] is [0.100000, 1217.142793], model default is [0.200000]
[ INFO] [1491992141.665339554, 0.164000000]: Bounds for joint[RLEG_JOINT1] is [0.100000, 2302.127302], model default is [0.200000]
[ INFO] [1491992141.665363111, 0.164000000]: Bounds for joint[RLEG_JOINT2] is [0.100000, 1711.767326], model default is [0.200000]
[ INFO] [1491992141.665382628, 0.164000000]: Bounds for joint[RLEG_JOINT3] is [0.100000, 2114.268486], model default is [0.200000]
[ INFO] [1491992141.665406050, 0.164000000]: Bounds for joint[RLEG_JOINT4] is [0.100000, 1295.436245], model default is [0.200000]
[ INFO] [1491992141.665425856, 0.164000000]: Bounds for joint[RLEG_JOINT5] is [0.100000, 399.765500], model default is [0.200000]
[ INFO] [1491992141.665444192, 0.164000000]: Bounds for joint[RLEG_JOINT6] is [0.100000, 202.499297], model default is [0.200000]
[ INFO] [1491992141.665466045, 0.164000000]: Bounds for joint[LLEG_JOINT0] is [0.100000, 1217.142793], model default is [0.200000]
[ INFO] [1491992141.665487406, 0.164000000]: Bounds for joint[LLEG_JOINT1] is [0.100000, 2302.127302], model default is [0.200000]
[ INFO] [1491992141.665548318, 0.164000000]: Bounds for joint[LLEG_JOINT2] is [0.100000, 1711.767326], model default is [0.200000]
[ INFO] [1491992141.665577194, 0.164000000]: Bounds for joint[LLEG_JOINT3] is [0.100000, 2114.268486], model default is [0.200000]
[ INFO] [1491992141.665606858, 0.164000000]: Bounds for joint[LLEG_JOINT4] is [0.100000, 1295.436245], model default is [0.200000]
[ INFO] [1491992141.665636949, 0.164000000]: Bounds for joint[LLEG_JOINT5] is [0.100000, 399.765500], model default is [0.200000]
[ INFO] [1491992141.665667328, 0.164000000]: Bounds for joint[LLEG_JOINT6] is [0.100000, 202.499297], model default is [0.200000]
[ INFO] [1491992141.665699791, 0.164000000]: Bounds for joint[CHEST_JOINT0] is [0.100000, 1724.149681], model default is [0.200000]
[ INFO] [1491992141.665733061, 0.164000000]: Bounds for joint[CHEST_JOINT1] is [0.100000, 5819.388224], model default is [0.200000]
[ INFO] [1491992141.665763376, 0.164000000]: Bounds for joint[HEAD_JOINT0] is [0.100000, 69.800008], model default is [0.200000]
[ INFO] [1491992141.665794235, 0.164000000]: Bounds for joint[HEAD_JOINT1] is [0.100000, 69.800008], model default is [0.200000]
[ INFO] [1491992141.665831749, 0.164000000]: Bounds for joint[RARM_JOINT0] is [0.100000, 1921.859564], model default is [0.200000]
[ INFO] [1491992141.665869408, 0.164000000]: Bounds for joint[RARM_JOINT1] is [0.100000, 2075.066138], model default is [0.200000]
[ INFO] [1491992141.665902933, 0.164000000]: Bounds for joint[RARM_JOINT2] is [0.100000, 585.760370], model default is [0.200000]
[ INFO] [1491992141.665935798, 0.164000000]: Bounds for joint[RARM_JOINT3] is [0.100000, 2424.299299], model default is [0.200000]
[ INFO] [1491992141.665966003, 0.164000000]: Bounds for joint[RARM_JOINT4] is [0.100000, 146.998481], model default is [0.200000]
[ INFO] [1491992141.666001692, 0.164000000]: Bounds for joint[RARM_JOINT5] is [0.100000, 141.197603], model default is [0.200000]
[ INFO] [1491992141.666037479, 0.164000000]: Bounds for joint[RARM_JOINT6] is [0.100000, 289.077838], model default is [0.200000]
[ INFO] [1491992141.666068524, 0.164000000]: Bounds for joint[RARM_JOINT7] is [0.100000, 146.998481], model default is [0.200000]
[ INFO] [1491992141.666102276, 0.164000000]: Bounds for joint[LARM_JOINT0] is [0.100000, 1921.859564], model default is [0.200000]
[ INFO] [1491992141.666138399, 0.164000000]: Bounds for joint[LARM_JOINT1] is [0.100000, 2075.066138], model default is [0.200000]
[ INFO] [1491992141.666174600, 0.164000000]: Bounds for joint[LARM_JOINT2] is [0.100000, 585.760370], model default is [0.200000]
[ INFO] [1491992141.666209401, 0.164000000]: Bounds for joint[LARM_JOINT3] is [0.100000, 2424.299299], model default is [0.200000]
[ INFO] [1491992141.666243578, 0.164000000]: Bounds for joint[LARM_JOINT4] is [0.100000, 146.998481], model default is [0.200000]
[ INFO] [1491992141.666285203, 0.164000000]: Bounds for joint[LARM_JOINT5] is [0.100000, 141.197603], model default is [0.200000]
[ INFO] [1491992141.666324860, 0.164000000]: Bounds for joint[LARM_JOINT6] is [0.100000, 289.077838], model default is [0.200000]
[ INFO] [1491992141.666359856, 0.164000000]: Bounds for joint[LARM_JOINT7] is [0.100000, 146.998481], model default is [0.200000]
[ INFO] [1491992141.666393802, 0.164000000]: Bounds for joint[L_THUMBCM_Y] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666428008, 0.164000000]: Bounds for joint[L_THUMBCM_P] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666458998, 0.164000000]: Bounds for joint[L_INDEXMP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666493697, 0.164000000]: Bounds for joint[L_INDEXMP_P] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666528673, 0.164000000]: Bounds for joint[L_INDEXPIP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666563568, 0.164000000]: Bounds for joint[L_MIDDLEPIP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666598553, 0.164000000]: Bounds for joint[R_THUMBCM_Y] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666629547, 0.164000000]: Bounds for joint[R_THUMBCM_P] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666661334, 0.164000000]: Bounds for joint[R_INDEXMP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666692474, 0.164000000]: Bounds for joint[R_INDEXMP_P] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666721912, 0.164000000]: Bounds for joint[R_INDEXPIP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ INFO] [1491992141.666754079, 0.164000000]: Bounds for joint[R_MIDDLEPIP_R] is [0.100000, 5000.000000], model default is [0.200000]
[ WARN] [1491992141.670559721, 0.164000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT0/
[ WARN] [1491992141.672055821, 0.165000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT1/
[ WARN] [1491992141.675153722, 0.165000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT2/
[ WARN] [1491992141.677484340, 0.166000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT3/
[ WARN] [1491992141.680708204, 0.168000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT4/
[ WARN] [1491992141.685731119, 0.170000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT5/
[ WARN] [1491992141.691264160, 0.171000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RLEG_JOINT6/
[ WARN] [1491992141.694906239, 0.173000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT0/
[ WARN] [1491992141.697168546, 0.173000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT1/
[ WARN] [1491992141.699327613, 0.174000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT2/
[ WARN] [1491992141.701132412, 0.175000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT3/
[ WARN] [1491992141.703155633, 0.175000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT4/
[ WARN] [1491992141.705329532, 0.176000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT5/
[ WARN] [1491992141.707260524, 0.177000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LLEG_JOINT6/
[ WARN] [1491992141.708826274, 0.177000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT0/
[ WARN] [1491992141.710506877, 0.178000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/CHEST_JOINT1/
[ WARN] [1491992141.712238809, 0.179000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT0/
[ WARN] [1491992141.713711547, 0.180000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/HEAD_JOINT1/
[ WARN] [1491992141.715257972, 0.180000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT0/
[ WARN] [1491992141.717055978, 0.181000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT1/
[ WARN] [1491992141.718769974, 0.182000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT2/
[ WARN] [1491992141.720640726, 0.182000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT3/
[ WARN] [1491992141.722532527, 0.183000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT4/
[ WARN] [1491992141.725787643, 0.184000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT5/
[ WARN] [1491992141.727545253, 0.185000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT6/
[ WARN] [1491992141.728624214, 0.185000000]: IOBPlugin: couldn't find a P_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT7/
[ WARN] [1491992141.729523892, 0.186000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/RARM_JOINT7/
[ WARN] [1491992141.731393239, 0.187000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT0/
[ WARN] [1491992141.732944628, 0.188000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT1/
[ WARN] [1491992141.734669555, 0.189000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT2/
[ WARN] [1491992141.736347257, 0.189000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT3/
[ WARN] [1491992141.738181806, 0.190000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT4/
[ WARN] [1491992141.740171990, 0.191000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT5/
[ WARN] [1491992141.741742351, 0.192000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT6/
[ WARN] [1491992141.742520044, 0.192000000]: IOBPlugin: couldn't find a P_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT7/
[ WARN] [1491992141.743483933, 0.193000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/LARM_JOINT7/
[ WARN] [1491992141.745167869, 0.193000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_Y/
[ WARN] [1491992141.746776086, 0.194000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_THUMBCM_P/
[ WARN] [1491992141.748516135, 0.195000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_R/
[ WARN] [1491992141.750429454, 0.196000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXMP_P/
[ WARN] [1491992141.753614333, 0.197000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_INDEXPIP_R/
[ WARN] [1491992141.755527026, 0.198000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/L_MIDDLEPIP_R/
[ WARN] [1491992141.757149576, 0.199000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_Y/
[ WARN] [1491992141.758938420, 0.199000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_THUMBCM_P/
[ WARN] [1491992141.760504041, 0.200000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_R/
[ WARN] [1491992141.762237981, 0.201000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXMP_P/
[ WARN] [1491992141.763823896, 0.202000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_INDEXPIP_R/
[ WARN] [1491992141.765619521, 0.202000000]: IOBPlugin: couldn't find a VP_V param for HRP2JSKNTS/hrpsys_gazebo_configuration/gains/R_MIDDLEPIP_R/

ODE Message 3: LCP internal error, s <= 0 (s=-0.0000e+00)

@robograffitti
Copy link
Member

robograffitti commented Jun 20, 2017

@iory 遅くなりましたが、該当のコミットを自分の環境でsamplerobotを使って試してみましたが、やっぱり回転しますね。

まだ原因をしっかり突き止めてなくてあくまで予想なのですが、何か重力や物理シミュレーションに関係する設定が上手く働いてないのかもしれません。このケースに関しては初期状態でモデルに働いている重力がゼロのような挙動に見えます。hrpsysを入れるとリアルタイムファクターが1になってものすごい勢いで吹っ飛んでいきますね・・・。

今、hrpsysとは関係ない話題でDRC-Huboをsrcsimの中で動くようにしましたが、重力をz=-9.8に設定してしまうと、床から受ける反力が大きくなりすぎるのか、モデルをデプロイした後に着地して重力を有効にした瞬間にものすごい勢いで吹っ飛ばされてモデルが粉々になってしまうので、火星の重力のz=-3.711で動かしているところです。

drc_huboのgazebo7対応は@ioryの修正がとても参考になりました。ありがとうございます。
JeongsooLim/drc_hubo#9

ちなみに、pr2はgazebo7で問題なく動きました。

@Naoki-Hiraoka
Copy link
Contributor

kinetic+gazebo7+EEFMQPCOPで,hrp2が歩きました.

動画
https://drive.google.com/open?id=1AQIyhrAJUNcECSHHaqseSL-6s4ImbHug

hrpsys-baseは
fkanehiro/hrpsys-base@ddad4fe
rtmros_tutorialsは
https://github.com/Naoki-Hiraoka/rtmros_tutorials/tree/gazebo-hrp2-walk
rtmros_gazeboは
https://github.com/Naoki-Hiraoka/rtmros_gazebo/tree/gazebo-hrp2-walk
を使用し,他は現時点のmasterを使用しました.

roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch
rtmlaunch hrpsys_gazebo_tutorials hrp2jsknts_hrpsys_bringup.launch
roseus ./hrp2jsknts-interface.l
(hrp2jsknts-init)
(setq *robot* (instance hrp2jsknts-robot :init))
(send *ri* :start-auto-balancer);;倒れたらstop-auto-balancer,Ctrl-Shift-rしてやり直す
;;揺れが収まるまで待つ
(send *ri* :angle-vector (send *robot* :reset-pose) 3000)
;;揺れが収まるまで十分待つ
(send *ri* :start-st)
(send *ri* :go-pos 1 0 0)

無重力のように見える問題
->use_loose_synchronizedをtrueにしていると,hrpsysを立ち上げないとシミュレーションがゆっくりになる仕様でした.
hrp2が吹っ飛ぶ問題
->use_velocity_feedbackをfalseにしました.trueだと地面にぶつかる瞬間に速度を維持しようとして瞬間的に2000Nm近くのトルクが出て吹っ飛ぶようです.
関節が振動する問題
->inertiaのixx,iyy,izzの最小値をもとの100倍にしました.
->関節のfriction,dampingを大きくしました.
->gazebo側のIOBPluginの関節制御アルゴリズムを,単純なPD制御にしました.
start-stすると転ぶ問題
->hrp2の全身の振り子のような揺れが収まるまで十分待ってからstart-stすると転びませんでした.

@mmurooka
Copy link
Member

mmurooka commented Sep 1, 2018

すばらしいです!
rtmros_tutorialsとrtmros_gazeboの変更を既存のプログラムと共存できるか確認しつつマージしていきましょう.

@Naoki-Hiraoka
Copy link
Contributor

Naoki-Hiraoka commented Sep 18, 2018

kinetic+gazebo7で、hrp2017のシミュレーションを行えるようにしました。
先述の歩行を可能にするための変更に加え、新たに以下を可能にするための変更を行いました。

  • 始めクレーンから吊り下がってサーボオフの状態から開始する
  • 実機と(ほぼ)同じlaunchファイルやconfigファイルを使用し、実機と(ほぼ)同じ手続きでrtcdなどを立ち上げる
  • HRP3Handが動かせる
  • カメラのトピック名をcamera_remoteにする、取り付け位置をcamera_depth_frameにする
  • arduinoによるモータ表面温度の計測結果のトピックがシミュレーションできる

実行時の動画です
https://drive.google.com/open?id=1t3cuELUX_27rx4UJubFC9Z_Lk71o26PP

既存のプログラムとの干渉が心配なのは、

  • IOBPluginの各関数名がgazebo7用になっていること(https://github.com/iory/rtmros_gazebo/tree/kinetic-devel を使用しました)
  • hrpsys_gazebo_msgsのJointCommand.msg、RobotState.msgに要素が追加されたこと
  • IOBPluginやiob.cppが、パラメータuse_servo_onをtrueにした場合の挙動が変更になったこと(hrpsys_gazebo_tutorials内のロボットはuse_servo_onをtrueにしているものは無いので問題ないと思われます)
  • ThermoPluginの挙動が完全に変わったこと(hrpsys_gazebo_tutorials内のロボットはこのpluginを使用していないようです)
  • 従来のhrp2jskntsのシミュレーションで使用するhrp2jsknts_hrpsys_bringup.launchは、今回修正されたロボットモデルやconfigファイルを共通で使用するため明らかに影響を受けていること

です。
以下、使用方法になります。

hrpsys_gazebo_general
https://github.com/Naoki-Hiraoka/rtmros_gazebo/tree/gazebo-hrp2jsknts
hrpsys_gazebo_tutorials
https://github.com/Naoki-Hiraoka/rtmros_tutorials/tree/gazebo-hrp2jsknts
jsk_hrp2_ros_bridge(private)
https://github.com/Naoki-Hiraoka/rtmros_hrp2/tree/gazebo-hrp2jsknts
hrpsysは
fkanehiro/hrpsys-base@eb5a3f7
を使用する.(これ以降はport番号を変更するコミットがmergeされており、rosbridgeが立ち上がらないため)
他は現時点のmasterを使用する(jsk-hrp2-ros-bridge,jsk-ros-pkg/jsk_3rdpartyが必要)

~/.bashrcで,
冒頭を以下のようにする

 # case $- in
 #      *i*) ;;
 #        *) return;;
 # esac
 [ -z "$PS1" ] && return 

~/.bashrcに以下を追加

source /opt/ros/kinetic/setup.bash
source {workspace}/devel/setup.bash
export ROBOT=HRP2JSKNTS
export HRP2NO=17

以下を行っておく

sudo apt-get install ros-kinetic-voice-text
sudo apt-get install ros-kinetic-jsk-calibration
sudo apt-get install ros-kinteic-pr2-teleop
sudo apt-get install ros-kinetic-pr2-computer-monitor

以下の2つのプログラムを順番に立ち上げるとシミュレーションできる
gazebo

roslaunch hrpsys_gazebo_tutorials gazebo_hrp2jsknts_no_controllers.launch

dashboard

roslaunch hrpsys_gazebo_tutorials hrp2_dashboard_gazebo.launch

itohdak pushed a commit to itohdak/rtmros_tutorials that referenced this issue Jan 10, 2019
[README.md] start auto-balancer before go-pos.
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

8 participants