0.001 0 0 -9.81 fcl_mesh 0 0 -0.55 0 0 0 0 0 0 0 0 0 10.0 10.0 0.1 0 0 0 0 0 0 10.0 10.0 0.1 world ground 0 2.1 0 0 0 0 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 0 -2.1 0 0 0 3.1416 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 -2.1 0 0 0 0 1.5708 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 2.1 0 0 0 0 -1.5708 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 1.48 1.48 0 0 0 -0.7854 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 1.48 -1.48 0 0 0 -2.3562 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 -1.48 -1.48 0 0 0 2.3562 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0 -1.48 1.48 0 0 0 0.7854 0 0 0 0 0 0 100 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 0.01 0 0 0 0.8 0.02 -0.275 0 1.1 0 0 0 0.2 0.2 2.2 0 0 2.1 -1.5708 0 0 1 0 0 0.5 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 -0.05 0 0 0 1.5708 0 0.1 0.3 0 0 1.0 0 1.5708 0 0.1 0.2 0 0 0.5 0 0 0 0.1 0.9 0.25 1.0 2.1 -2 0 0 1 0 0 0.5 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 0 0 0 0 1.5708 0 0.08 0.3 0 0 0.5 0 0 0 0.1 0.9 world base 0 0 0 0 0 0 base upper_link 0 0 0 0 0 0 1 0 0 upper_link lower_link 0 0 0 0 0 0 1 0 0