0.001 0 -9.81 0 fcl_mesh 1 0 0 0 0 0 0 5 0 0.5 0 0 0.5 0 0 0 0 0.1 1.0 0.1 0 0.5 0 0 0 0 0.1 1.0 0.1 1 0 1.0 0 0 0 0 5 0 0.5 0 0 0.5 0 0 0 0 0.1 1.0 0.1 0 0.5 0 0 0 0 0.1 1.0 0.1 1 0 1.0 0 0 0 0 5 0 0.5 0 0 0.5 0 0 0 0 0.1 1.0 0.1 0 0.5 0 0 0 0 0.1 1.0 0.1 1 0 1.0 0 0 0 0 5 0 0.5 0 0 0.5 0 0 0 0 0.1 1.0 0.1 0 0.5 0 0 0 0 0.1 1.0 0.1 1 0 1.0 0 0 0 0 5 0 0.5 0 0 0.5 0 0 0 0 0.1 1.0 0.1 0 0.5 0 0 0 0 0.1 1.0 0.1 world link 1 -0 0 0 0 0 0 1 0 0 link 1 link 2 -0 0 0 0 0 0 1 0 0 -1.57 +1.57 link 2 link 3 0 0 0 0 0 0 1 0 0 link 3 link 4 0 0 0 0 0 0 1 0 0 -1 +1 0 1 0 -2 +2 link 4 link 5 0 0 0 0 0 0 xyz