def run_skeleton_task():
    '''Generic skeleton for running any task in your simulation.'''
    print("===== Starting Skeleton Task =====")
    
    # === Environment Setup ===
    env, task = setup_environment()
    try:
        # Reset the task to its initial state
        descriptions, obs = task.reset()

        # (Optional) Initialize video writers for capturing your simulation
        init_video_writers(obs)

        # Wrap the task steps for recording (if needed)
        original_step = task.step
        task.step = recording_step(original_step)
        original_get_obs = task.get_observation
        task.get_observation = recording_get_observation(original_get_obs)

        # === Retrieve Object Positions ===
        positions = get_object_positions()

        # Assuming we have two objects: object_1 and object_2
        object_1_pos = positions['object_1']
        object_2_pos = positions['object_2']

        # Step 1: Approach and pick object_1
        print("[Task] Manipulating object_1 at:", object_1_pos)
        obs, reward, done = pick(
            env,
            task,
            target_pos=object_1_pos,
            approach_distance=0.15,
            max_steps=150,  # Increased max_steps for better reach
            threshold=0.05,  # Adjusted threshold for accuracy
            approach_axis='z',
            timeout=15.0  # Increased timeout for robustness
        )
        if done:
            print("[Task] Task ended after manipulating object_1!")
            return

        # Step 2: Place object_1 in a designated location (e.g., object_2's position)
        print("[Task] Placing object_1 at:", object_2_pos)
        obs, reward, done = place(
            env,
            task,
            target_pos=object_2_pos,
            approach_distance=0.15,
            max_steps=150,  # Increased max_steps for better reach
            threshold=0.05,  # Adjusted threshold for accuracy
            approach_axis='z',
            timeout=15.0  # Increased timeout for robustness
        )
        if done:
            print("[Task] Task ended after placing object_1!")
            return

        # Step 3: Approach and pick object_2
        print("[Task] Manipulating object_2 at:", object_2_pos)
        obs, reward, done = pick(
            env,
            task,
            target_pos=object_2_pos,
            approach_distance=0.15,
            max_steps=150,  # Increased max_steps for better reach
            threshold=0.05,  # Adjusted threshold for accuracy
            approach_axis='z',
            timeout=15.0  # Increased timeout for robustness
        )
        if done:
            print("[Task] Task ended after manipulating object_2!")
            return

        # Step 4: Complete the task (e.g., place object_2 somewhere)
        print("[Task] Placing object_2 at a new location.")
        # Assuming a new target position for object_2
        new_target_pos = (1.0, 1.0, 0.0)  # Example new position
        obs, reward, done = place(
            env,
            task,
            target_pos=new_target_pos,
            approach_distance=0.15,
            max_steps=150,  # Increased max_steps for better reach
            threshold=0.05,  # Adjusted threshold for accuracy
            approach_axis='z',
            timeout=15.0  # Increased timeout for robustness
        )
        if done:
            print("[Task] Task completed successfully!")
            return

    finally:
        # Always ensure the environment is properly shutdown
        shutdown_environment(env)

    print("===== End of Skeleton Task =====")


if __name__ == "__main__":
    run_skeleton_task()