RSC-MyPolicy-checkpoints / sample_loading_headb /action_config_fallback.json
liyifreddy's picture
Add sample_loading_headb/ (sample_loading head-B expert: planner + head A/B estimators + frozen geometry)
c4a31d8 verified
Raw History Blame Contribute Delete
71.2 kB
{ "scope": { "right_arm": { "type": "DiGraph", "dim": [ 6 ], "init": { "method": "current_qpos", "init_node_name": "right_arm_init_qpos" }, "dtype": "float32" }, "left_arm": { "type": "DiGraph", "dim": [ 6 ], "init": { "method": "current_qpos", "init_node_name": "left_arm_init_qpos" }, "dtype": "float32" }, "left_eef": { "type": "DiGraph", "dim": [ 1 ], "init": { "method": "given_qpos", "kwargs": { "given_qpos": [ 0 ] }, "init_node_name": "" }, "dtype": "float32" }, "right_eef": { "type": "DiGraph", "dim": [ 1 ], "init": { "method": "given_qpos", "kwargs": { "given_qpos": [ 0 ] }, "init_node_name": "" }, "dtype": "float32" } }, "node": { "right_arm": [ { "right_arm_init_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_init_qpos", "dst_key": "right_arm_init_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_fk_xpos", "kwargs": { "control_part": "right_arm", "fk_func": "env.robot.compute_fk" } } ] } ] } ] } } }, { "right_arm_aim_qpos": { "name": "generate_right_arm_aim_qpos", "kwargs": {} } }, { "right_arm_cube_grasp": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "cube_grasp_pose", "dst_key": "right_arm_cube_grasp_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_aligned_pose", "kwargs": { "align_vector": [ 0, 0, -1 ], "pose_axis": "x" } }, { "name": "get_aligned_pose", "kwargs": { "align_vector": [ 0, 0, -1 ], "pose_axis": "y" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 90, "rot_axis": "y", "mode": "intrinsic", "degrees": true } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 180, "rot_axis": "z", "mode": "intrinsic", "degrees": true } }, { "name": "get_aligned_pose", "kwargs": { "align_vector": [ 0, 0, -1 ], "pose_axis": "z" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": -0.0044, "direction": "z", "mode": "extrinsic" } } ] } ] }, { "src_key": "right_arm_cube_grasp_pose", "dst_key": "right_arm_cube_pre1_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": -0.05, "direction": "z", "mode": "intrinsic" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": -0.0, "direction": "x", "mode": "intrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 20, "rot_axis": "y", "mode": "intrinsic", "degrees": true } } ] } ] } ] } } }, { "right_arm_cube_pre1_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_pre1_pose", "dst_key": "right_arm_cube_pre1_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_aim_qpos']", "control_part": "right_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_aim_qpos']", "control_part": "right_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['right_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "right_arm_cube_grasp_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_grasp_pose", "dst_key": "right_arm_cube_grasp_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_pre1_qpos']", "control_part": "right_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_pre1_qpos']", "control_part": "right_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['right_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "right_arm_cube_up1_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_grasp_pose", "dst_key": "right_arm_cube_up1_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": 0.2, "direction": "z", "mode": "extrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 30, "rot_axis": "y", "mode": "intrinsic", "degrees": true } } ] } ] } ] } } }, { "right_arm_cube_up1_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_up1_pose", "dst_key": "right_arm_cube_up1_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_grasp_qpos']", "control_part": "right_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_grasp_qpos']", "control_part": "right_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['right_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "right_arm_aim_rack_qpos": { "name": "generate_right_arm_aim_rack_qpos", "kwargs": {} } }, { "right_arm_cube_up2_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_up1_pose", "dst_key": "right_arm_cube_up2_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_rotation_replaced_pose", "kwargs": { "rotation_value": "env.affordance_datas['right_arm_aim_rack_qpos'][0]", "rot_axis": "z", "mode": "intrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 20, "rot_axis": "z", "mode": "intrinsic", "degrees": true } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": -90, "rot_axis": "y", "mode": "intrinsic", "degrees": true } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 180, "rot_axis": "x", "mode": "intrinsic", "degrees": true } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.15, "direction": "z", "mode": "extrinsic" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.05, "direction": "x", "mode": "extrinsic" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.1, "direction": "y", "mode": "extrinsic" } } ] } ] } ] } } }, { "right_arm_cube_up2_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_up2_pose", "dst_key": "right_arm_cube_up2_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_up1_qpos']", "control_part": "right_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['right_arm_cube_up1_qpos']", "control_part": "right_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['right_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "right_arm_back_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_up2_qpos", "dst_key": "right_arm_back_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_qpos", "kwargs": { "offset_value": -15, "joint_list_offset": [ 0 ], "degrees": true } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['right_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } } ], "left_arm": [ { "left_arm_init_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_init_qpos", "dst_key": "left_arm_init_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_fk_xpos", "kwargs": { "control_part": "left_arm", "fk_func": "env.robot.compute_fk" } } ] } ] } ] } } }, { "left_arm_aim_qpos": { "name": "generate_left_arm_aim_qpos", "kwargs": {} } }, { "left_arm_takeover_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "right_arm_cube_up2_pose", "dst_key": "left_arm_takeover_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": -0.06, "direction": "x", "mode": "intrinsic" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.01, "direction": "z", "mode": "intrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": -90, "rot_axis": "x", "mode": "intrinsic", "degrees": true } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.015, "direction": "z", "mode": "intrinsic" } } ] } ] } ] } } }, { "left_arm_takeover_pre_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_takeover_pose", "dst_key": "left_arm_takeover_pre_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_rotated_pose", "kwargs": { "rot_angle": 10, "rot_axis": "x", "mode": "intrinsic", "degrees": true } }, { "name": "get_offset_pose", "kwargs": { "offset_value": -0.1, "direction": "z", "mode": "intrinsic" } } ] } ] } ] } } }, { "left_arm_takeover_pre_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_takeover_pre_pose", "dst_key": "left_arm_takeover_pre_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_aim_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_aim_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "left_arm_takeover_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_takeover_pose", "dst_key": "left_arm_takeover_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_takeover_pre_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_takeover_pre_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "left_arm_cube_place_position": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "rack_pose", "dst_key": "left_arm_cube_place_temp_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": 0.09, "direction": "z", "mode": "extrinsic" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.011, "direction": "x", "mode": "intrinsic" } } ] } ] } ] } } }, { "left_arm_cube_place_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_takeover_pose", "dst_key": "left_arm_cube_place_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_rotation_replaced_pose", "kwargs": { "rotation_value": "env.affordance_datas['left_arm_aim_qpos'][0]", "rot_axis": "z", "mode": "intrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 90, "rot_axis": "y", "mode": "intrinsic", "degrees": true } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": 180, "rot_axis": "z", "mode": "intrinsic", "degrees": true } }, { "name": "get_replaced_pose", "kwargs": { "pose_replace_value": "env.affordance_datas['left_arm_cube_place_temp_pose'][:3,3]", "axis_str_replace": "xyz" } }, { "name": "get_offset_pose", "kwargs": { "offset_value": 0.015, "direction": "z", "mode": "intrinsic" } }, { "name": "get_rotated_pose", "kwargs": { "rot_angle": -3.4, "rot_axis": "y", "mode": "intrinsic", "degrees": true } } ] } ] } ] } } }, { "left_arm_cube_place_pre_waypoint1_pose_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_cube_place_pose", "dst_key": "left_arm_cube_place_pre_waypoint1_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": 0.1, "direction": "z", "mode": "extrinsic" } } ] } ] }, { "src_key": "left_arm_cube_place_pre_waypoint1_pose", "dst_key": "left_arm_cube_place_pre_waypoint1_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_aim_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_aim_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "left_arm_cube_place_pre_waypoint2_pose_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_cube_place_pose", "dst_key": "left_arm_cube_place_pre_waypoint2_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": 0.075, "direction": "z", "mode": "extrinsic" } } ] } ] }, { "src_key": "left_arm_cube_place_pre_waypoint2_pose", "dst_key": "left_arm_cube_place_pre_waypoint2_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_waypoint1_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_waypoint1_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "left_arm_cube_place_pre_pose": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_cube_place_pose", "dst_key": "left_arm_cube_place_pre_pose", "valid_funcs_name_kwargs_proc": [ { "name": "no_validation", "kwargs": {}, "pass_processes": [ { "name": "get_offset_pose", "kwargs": { "offset_value": 0.05, "direction": "z", "mode": "extrinsic" } } ] } ] } ] } } }, { "left_arm_cube_place_pre_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_cube_place_pre_pose", "dst_key": "left_arm_cube_place_pre_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_waypoint2_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_waypoint2_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } }, { "left_arm_cube_place_qpos": { "name": "generate_affordances_from_src", "kwargs": { "affordance_infos": [ { "src_key": "left_arm_cube_place_pose", "dst_key": "left_arm_cube_place_qpos", "valid_funcs_name_kwargs_proc": [ { "name": "get_ik_ret", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_qpos']", "control_part": "left_arm" }, "pass_processes": [ { "name": "get_ik_qpos", "kwargs": { "ik_func": "env.robot.compute_ik", "qpos_seed": "env.affordance_datas['left_arm_cube_place_pre_qpos']", "control_part": "left_arm" } } ] }, { "name": "is_qpos_flip", "kwargs": { "qpos_ref": "env.affordance_datas['left_arm_init_qpos']", "qpos_ids": [ 3, 4 ], "threshold": 3.455751918948773, "mode": "delta", "return_inverse": true } } ] } ] } } } ], "left_eef": [ { "close_init": { "name": "execute_close", "kwargs": {} } }, { "open": { "name": "execute_open", "kwargs": {} } }, { "close": { "name": "execute_close", "kwargs": {} } } ], "right_eef": [ { "rclose_init": { "name": "execute_close", "kwargs": {} } }, { "ropen": { "name": "execute_open", "kwargs": {} } }, { "rclose": { "name": "execute_close", "kwargs": {} } } ] }, "edge": { "right_arm": [ { "init_to_pre1": { "src": "right_arm_init_qpos", "sink": "right_arm_cube_pre1_qpos", "duration": 35, "name": "plan_trajectory", "kwargs": { "agent_uid": "right_arm", "keypose_names": [ "right_arm_init_qpos", "right_arm_cube_pre1_qpos" ] } } }, { "pre1_to_grasp": { "src": "right_arm_cube_pre1_qpos", "sink": "right_arm_cube_grasp_qpos", "duration": 35, "name": "plan_trajectory", "kwargs": { "agent_uid": "right_arm", "keypose_names": [ "right_arm_cube_pre1_qpos", "right_arm_cube_grasp_qpos" ] } } }, { "grasp_to_up1": { "src": "right_arm_cube_grasp_qpos", "sink": "right_arm_cube_up1_qpos", "duration": 25, "name": "plan_trajectory", "kwargs": { "agent_uid": "right_arm", "keypose_names": [ "right_arm_cube_grasp_qpos", "right_arm_cube_up1_qpos" ] } } }, { "up1_to_up2": { "src": "right_arm_cube_up1_qpos", "sink": "right_arm_cube_up2_qpos", "duration": 35, "name": "plan_trajectory", "kwargs": { "agent_uid": "right_arm", "keypose_names": [ "right_arm_cube_up1_qpos", "right_arm_cube_up2_qpos" ] } } }, { "up2_to_back": { "src": "right_arm_cube_up2_qpos", "sink": "right_arm_back_qpos", "duration": 24, "name": "plan_trajectory", "kwargs": { "agent_uid": "right_arm", "keypose_names": [ "right_arm_cube_up2_qpos", "right_arm_back_qpos" ] } } } ], "left_arm": [ { "left_init_to_takeover_pre": { "src": "left_arm_init_qpos", "sink": "left_arm_takeover_pre_qpos", "duration": 50, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_init_qpos", "left_arm_takeover_pre_qpos" ] } } }, { "left_pre_to_takeover": { "src": "left_arm_takeover_pre_qpos", "sink": "left_arm_takeover_qpos", "duration": 20, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_takeover_pre_qpos", "left_arm_takeover_qpos" ] } } }, { "left_takeover_to_pre1": { "src": "left_arm_takeover_qpos", "sink": "left_arm_cube_place_pre_waypoint1_qpos", "duration": 35, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_takeover_qpos", "left_arm_cube_place_pre_waypoint1_qpos" ] } } }, { "left_pre1_to_pre2": { "src": "left_arm_cube_place_pre_waypoint1_qpos", "sink": "left_arm_cube_place_pre_waypoint2_qpos", "duration": 15, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_cube_place_pre_waypoint1_qpos", "left_arm_cube_place_pre_waypoint2_qpos" ] } } }, { "left_pre2_to_pre": { "src": "left_arm_cube_place_pre_waypoint2_qpos", "sink": "left_arm_cube_place_pre_qpos", "duration": 15, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_cube_place_pre_waypoint2_qpos", "left_arm_cube_place_pre_qpos" ] } } }, { "left_pre_to_place": { "src": "left_arm_cube_place_pre_qpos", "sink": "left_arm_cube_place_qpos", "duration": 15, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_cube_place_pre_qpos", "left_arm_cube_place_qpos" ] } } }, { "left_place_to_pre": { "src": "left_arm_cube_place_qpos", "sink": "left_arm_cube_place_pre_qpos", "duration": 15, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_cube_place_qpos", "left_arm_cube_place_pre_qpos" ] } } }, { "left_pre_to_pre1": { "src": "left_arm_cube_place_pre_qpos", "sink": "left_arm_cube_place_pre_waypoint1_qpos", "duration": 15, "name": "plan_trajectory", "kwargs": { "agent_uid": "left_arm", "keypose_names": [ "left_arm_cube_place_pre_qpos", "left_arm_cube_place_pre_waypoint1_qpos" ] } } } ], "left_eef": [ { "open0": { "src": "close_init", "sink": "open", "duration": 20, "name": "execute_open", "kwargs": { "return_action": true, "expand": true } } }, { "close0": { "src": "open", "sink": "close", "duration": 20, "name": "execute_close", "kwargs": { "return_action": true, "expand": true } } }, { "open1": { "src": "close", "sink": "open", "duration": 11, "name": "execute_open", "kwargs": { "return_action": true, "expand": true } } } ], "right_eef": [ { "ropen0": { "src": "rclose_init", "sink": "ropen", "duration": 10, "name": "execute_open", "kwargs": { "return_action": true, "expand": true } } }, { "rclose0": { "src": "ropen", "sink": "rclose", "duration": 20, "name": "execute_close", "kwargs": { "return_action": true, "expand": true } } }, { "ropen1": { "src": "rclose", "sink": "ropen", "duration": 11, "name": "execute_open", "kwargs": { "return_action": true, "expand": true } } } ] }, "sync": { "rclose0": { "depend_tasks": [ "pre1_to_grasp" ] }, "grasp_to_up1": { "depend_tasks": [ "rclose0" ] }, "ropen1": { "depend_tasks": [ "close0" ] }, "up2_to_back": { "depend_tasks": [ "ropen1" ] }, "left_init_to_takeover_pre": { "depend_tasks": [ "up1_to_up2" ] }, "close0": { "depend_tasks": [ "left_pre_to_takeover" ] }, "left_takeover_to_pre1": { "depend_tasks": [ "close0", "ropen1" ] }, "open1": { "depend_tasks": [ "left_pre_to_place" ] }, "left_place_to_pre": { "depend_tasks": [ "open1" ] } }, "misc": { "vis_graph": false, "vis_gantt": false, "warpping": true } }
{
"scope": {
"right_arm": {
"type": "DiGraph",
"dim": [
6
],
"init": {
"method": "current_qpos",
"init_node_name": "right_arm_init_qpos"
},
"dtype": "float32"
},
"left_arm": {
"type": "DiGraph",
"dim": [
6
],
"init": {
"method": "current_qpos",
"init_node_name": "left_arm_init_qpos"
},
"dtype": "float32"
},
"left_eef": {
"type": "DiGraph",
"dim": [
1
],
"init": {
"method": "given_qpos",
"kwargs": {
"given_qpos": [
0
]
},
"init_node_name": ""
},
"dtype": "float32"
},
"right_eef": {
"type": "DiGraph",
"dim": [
1
],
"init": {
"method": "given_qpos",
"kwargs": {
"given_qpos": [
0
]
},
"init_node_name": ""
},
"dtype": "float32"
}
},
"node": {
"right_arm": [
{
"right_arm_init_qpos": {
"name": "generate_affordances_from_src",
"kwargs": {
"affordance_infos": [
{
"src_key": "right_arm_init_qpos",
"dst_key": "right_arm_init_pose",
"valid_funcs_name_kwargs_proc": [
{
"name": "no_validation",
"kwargs": {},
"pass_processes": [
{
"name": "get_fk_xpos",
"kwargs": {
"control_part": "right_arm",
"fk_func": "env.robot.compute_fk"
}
}
]
}
]
}
]
}
}
},
{
"right_arm_aim_qpos": {
"name": "generate_right_arm_aim_qpos",
"kwargs": {}
}
},
{
"right_arm_cube_grasp": {
"name": "generate_affordances_from_src",
"kwargs": {
"affordance_infos": [
{
"src_key": "cube_grasp_pose",