{"root":"agv_base","joints":[{"name":"agv_right_back_rotate_joint","type":"revolute","parent":"right_wheel_steering_2","child":"right_wheel_rotate_2","xyz":[-0.015,0.0,-0.1484],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"agv_right_back_steering_joint","type":"revolute","parent":"agv_base","child":"right_wheel_steering_2","xyz":[-0.2745,-0.2045,0.2109],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"agv_right_front_rotate_joint","type":"revolute","parent":"right_wheel_steering","child":"right_wheel_rotate","xyz":[-0.015,0.0,-0.1484],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"agv_right_front_steering_joint","type":"revolute","parent":"agv_base","child":"right_wheel_steering","xyz":[0.2745,-0.2045,0.2109],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"agv_left_front_rotate_joint","type":"revolute","parent":"left_wheel_steering","child":"left_wheel_rotate","xyz":[-0.015,0.0,-0.1484],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"agv_left_front_steering_joint","type":"revolute","parent":"agv_base","child":"left_wheel_steering","xyz":[0.2745,0.2045,0.2109],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"agv_left_back_rotate_joint","type":"revolute","parent":"left_wheel_steering_2","child":"left_wheel_rotate_2","xyz":[-0.015,0.0,-0.1484],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"agv_left_back_steering_joint","type":"revolute","parent":"agv_base","child":"left_wheel_steering_2","xyz":[-0.2745,0.2045,0.2109],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"folding_low_joint","type":"revolute","parent":"agv_base","child":"folding_lower_joint_link","xyz":[-0.125,-0.000199,0.17],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"folding_high_joint","type":"revolute","parent":"folding_lower_joint_link","child":"folding_to_waist_link","xyz":[0.327498,0.0,0.308618],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"waist_pitch_joint","type":"revolute","parent":"folding_to_waist_link","child":"torso_waist_pitch_link","xyz":[-0.401053,0.0,0.204099],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"waist_yaw_joint","type":"revolute","parent":"torso_waist_pitch_link","child":"torso_body_link","xyz":[-0.007,0.0,0.172],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"head_yaw_joint","type":"revolute","parent":"torso_body_link","child":"head_yaw_link","xyz":[0.0,0.0,0.363],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"head_pitch_joint","type":"revolute","parent":"head_yaw_link","child":"head_pitch_link","xyz":[0.0,0.0,0.0415],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"head_roll_joint","type":"revolute","parent":"head_pitch_link","child":"head_roll_link","xyz":[0.002,0.0,0.0],"rpy":[0.0,0.0,0.0],"axis":[1.0,0.0,0.0]},{"name":"right_shoulder_pitch_joint","type":"revolute","parent":"torso_body_link","child":"right_shoulder_pitch_link","xyz":[0.0,-0.105,0.243],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"right_shoulder_roll_joint","type":"revolute","parent":"right_shoulder_pitch_link","child":"right_shoulder_roll_link","xyz":[0.0,-0.085,0.0],"rpy":[0.0,0.0,0.0],"axis":[1.0,0.0,0.0]},{"name":"right_shoulder_yaw_joint","type":"revolute","parent":"right_shoulder_roll_link","child":"right_shoulder_yaw_link","xyz":[0.0,0.0,-0.125],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"right_elbow_joint","type":"revolute","parent":"right_shoulder_yaw_link","child":"right_elbow_link","xyz":[0.015,0.0,-0.125],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"right_wrist_yaw_joint","type":"revolute","parent":"right_elbow_link","child":"right_wrist_yaw_link","xyz":[-0.01,0.0,-0.1025],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"right_wrist_pitch_joint","type":"revolute","parent":"right_wrist_yaw_link","child":"right_wrist_pitch_link","xyz":[0.0,0.0,-0.1525],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"right_wrist_roll_joint","type":"revolute","parent":"right_wrist_pitch_link","child":"right_wrist_roll_link","xyz":[0.0285,0.0,0.0],"rpy":[0.0,0.0,0.0],"axis":[1.0,0.0,0.0]},{"name":"right_gripper_joint_frame","type":"fixed","parent":"right_wrist_roll_link","child":"right_ee_fk_target_frame","xyz":[-0.02852,0.0,-0.088527],"rpy":[0.0,0.0,-1.5708],"axis":[0.0,0.0,0.0]},{"name":"right_gripper_front_joint","type":"prismatic","parent":"right_wrist_roll_link","child":"right_grippera_link","xyz":[-0.028953,-0.023048,-0.166971],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"right_gripper_tip_A_frame","type":"fixed","parent":"right_grippera_link","child":"right_gripper_tip_A","xyz":[0.000433,0.023068,-0.080556],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"right_gripper_rear_joint","type":"prismatic","parent":"right_wrist_roll_link","child":"right_gripperb_link","xyz":[-0.028088,0.023048,-0.166971],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"right_gripper_tip_B_frame","type":"fixed","parent":"right_gripperb_link","child":"right_gripper_tip_B","xyz":[-0.000432,-0.023068,-0.080556],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"left_shoulder_pitch_joint","type":"revolute","parent":"torso_body_link","child":"left_shoulder_pitch_link","xyz":[0.0,0.105,0.243],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"left_shoulder_roll_joint","type":"revolute","parent":"left_shoulder_pitch_link","child":"left_shoulder_roll_link","xyz":[0.0,0.085,0.0],"rpy":[0.0,0.0,0.0],"axis":[1.0,0.0,0.0]},{"name":"left_shoulder_yaw_joint","type":"revolute","parent":"left_shoulder_roll_link","child":"left_shoulder_yaw_link","xyz":[0.0,0.0,-0.125],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"left_elbow_joint","type":"revolute","parent":"left_shoulder_yaw_link","child":"left_elbow_link","xyz":[0.015,0.0,-0.125],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"left_wrist_yaw_joint","type":"revolute","parent":"left_elbow_link","child":"left_wrist_yaw_link","xyz":[-0.01,0.0,-0.1025],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,1.0]},{"name":"left_wrist_pitch_joint","type":"revolute","parent":"left_wrist_yaw_link","child":"left_wrist_pitch_link","xyz":[0.0,0.0,-0.1525],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"left_wrist_roll_joint","type":"revolute","parent":"left_wrist_pitch_link","child":"left_wrist_roll_link","xyz":[0.0285,0.0,0.0],"rpy":[0.0,0.0,0.0],"axis":[1.0,0.0,0.0]},{"name":"left_gripper_joint_frame","type":"fixed","parent":"left_wrist_roll_link","child":"left_ee_fk_target_frame","xyz":[-0.02852,0.0,-0.088527],"rpy":[0.0,0.0,-1.5708],"axis":[0.0,0.0,0.0]},{"name":"left_gripper_front_joint","type":"prismatic","parent":"left_wrist_roll_link","child":"left_grippera_link","xyz":[-0.028953,-0.023048,-0.166971],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"left_gripper_tip_A_frame","type":"fixed","parent":"left_grippera_link","child":"left_gripper_tip_A","xyz":[0.000433,0.023068,-0.080556],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"left_gripper_rear_joint","type":"prismatic","parent":"left_wrist_roll_link","child":"left_gripperb_link","xyz":[-0.028088,0.023048,-0.166971],"rpy":[0.0,0.0,0.0],"axis":[0.0,1.0,0.0]},{"name":"left_gripper_tip_B_frame","type":"fixed","parent":"left_gripperb_link","child":"left_gripper_tip_B","xyz":[-0.000432,-0.023068,-0.080556],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"head_camera_base_frame_joint","type":"fixed","parent":"head_roll_link","child":"head_camera_base_frame","xyz":[0.043,0.025,0.0485],"rpy":[-1.5708,0.0,-1.5708],"axis":[0.0,0.0,0.0]},{"name":"head_camera_left_optical_center_joint","type":"fixed","parent":"head_camera_base_frame","child":"head_camera_left_optical_center_frame","xyz":[-0.005,0.01,0.033203],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"head_camera_right_optical_center_joint","type":"fixed","parent":"head_camera_base_frame","child":"head_camera_right_optical_center_frame","xyz":[0.055,0.01,0.033203],"rpy":[0.0,0.0,0.0],"axis":[0.0,0.0,0.0]},{"name":"left_gripper_camera_frame","type":"fixed","parent":"left_wrist_roll_link","child":"left_gripper_camera","xyz":[0.056204,0.0,-0.150766],"rpy":[2.617994,0.0,-1.570796],"axis":[0.0,0.0,0.0]},{"name":"right_gripper_camera_frame","type":"fixed","parent":"right_wrist_roll_link","child":"right_gripper_camera","xyz":[0.056204,0.0,-0.150766],"rpy":[2.617994,0.0,-1.570796],"axis":[0.0,0.0,0.0]},{"name":"lidar_front_right_frame","type":"fixed","parent":"agv_base","child":"lidar_front_right","xyz":[0.292236,-0.227959,0.301378],"rpy":[0.613474,-0.606997,1.94896],"axis":[0.0,0.0,0.0]},{"name":"lidar_front_left_frame","type":"fixed","parent":"agv_base","child":"lidar_front_left","xyz":[0.292236,0.227959,0.301378],"rpy":[-0.616837,-0.603562,-1.94305],"axis":[0.0,0.0,0.0]},{"name":"lidar_back_frame","type":"fixed","parent":"agv_base","child":"lidar_back","xyz":[-0.3275,0.0,0.24995],"rpy":[0.0,0.0,1.5708],"axis":[0.0,0.0,0.0]},{"name":"agv_imu_frame_frame","type":"fixed","parent":"agv_base","child":"agv_imu_frame","xyz":[-0.1642,0.225,0.178],"rpy":[0.0,0.0,3.14159],"axis":[0.0,0.0,0.0]}]}