""" Inference Script for Visuomotor Diffusion Policy Engine ======================================================= Author: Ramprasad Atluri (At1uri) Repository: At1uri/visuomotor-diffusion-policy-engine """ from diffusion_policy_engine import VisuomotorDiffusionPolicyEngine def run_robotics_demo(): policy = VisuomotorDiffusionPolicyEngine() print("=" * 70) print("VISUOMOTOR DIFFUSION POLICY: MULTIMODAL OBSTACLE AVOIDANCE (DDIM-10)") print("=" * 70) for seed in [42, 7, 101]: res = policy.sample_action_chunk_ddim( start_xy=[0.20, -0.35], goal_xy=[0.20, 0.35], obs_xy=[0.20, 0.00], obs_radius=0.12, num_inference_steps=10, seed=seed ) print(f"\n[Rollout Seed = {seed}]") print(f" Selected Multimodal Branch: {res['selected_mode']}") print(f" DDIM Denoising Steps: {res['ddim_steps']}") print(f" Min Obstacle Clearance: {res['min_obstacle_clearance_m']} m (Collision-Free: {res['collision_free']})") print(f" Terminal Goal Error: {res['terminal_error_m']} m") # Solve 3-DOF Inverse Kinematics for target endpoint ik = policy.solve_inverse_kinematics(res["trajectory_xy"][-1]) print(f" 3-DOF IK Joint Angles (rad): {ik['joint_angles_rad']} | IK Error: {ik['position_error_m']} m") if __name__ == "__main__": run_robotics_demo()